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This thesis examines the use of a single, omnidirectional hydrophone as a 
receiving sensor to passively localize an acoustic beacon. The localization problem is 
presented as a constrained, nonlinear parameter estimation problem, and Lagrange 
multipliers are introduced to solve for the maximum likelihood estimate of the acoustic 
beacon's position. An iterative algorithm is developed using range difference 
measurements to solve for the maximum likelihood estimate of a stationary acoustic 
beacon's position. This algorithm is then extended to include linear, constant velocity 
motion of the acoustic beacon. Finally, design specifications for a receiver to 
implement the maximum likelihood estimation algorithms are developed. 

To test the maximum likelihood estimate algorithms, Monte Carlo simulations 
are conducted. Results from six representative scenarios are presented. Test results 
show that as the number of range differences used increases, or the distance that the 
observer travels between received beacon signals increases, the accuracy of the 
estimated position improves. Also, tests show that accuracy of the estimated beacon 
position 1s directly related to the accuracy in which the observer's position is 
measured. To test the receiver's design specifications, a prototype receiver is built 
using commonly available components. It is then shown that the prototype receiver 
meets or exceeds the design specifications. 
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Chapter I 
Introduction and Problem Statement 
1.1 Introduction 
There are many scenarios in which passive localization of an acoustic beacon is 
needed. Techniques like Target Motion Analysis and Bearings Only Ranging can 
passively estimate an acoustic beacon's position by using received bearing information. 
These techniques rely upon a multiple sensor receiving array to find the relative 


bearing between the acoustic beacon and the observer. To estimate the position of the 
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acoustic beacon, bearing lines from several different observation points are combined 
to form a fix. See figure 1-1. 

Recent developments in passive target ranging and tracking which use arrays of 
only a few elements can also be used to passively localize an acoustic beacon [Allen 
and King 1988] [Friedlander 1987] [Moose 1987]. These methods rely upon the array 
to estimate the relative bearing between the acoustic beacon and the observer as well. 
Statistical and test analyses have shown that the performance of the localization 
techniques mentioned above improves with increased distance between sensor elements 
in the receiving array [Moose 1987]. This typically leads to the use of long receiving 
arrays. The use of long arrays can become a problem if the ship used to deploy the 
array 1s small, or if budget constraints limit the size of the array. For these cases, the 
observer can employ a technique that uses a single omnidirectional sensor to form a 
synthetic aperture array instead of a conventional receiving array to passively localize 
the acoustic beacon. 

Previous techniques to localize acoustic beacons using a single omnidirectional 
hydrophone instead of an array use a raster scanning paper recording device to 
produce a mark on recording paper whenever a beacon signal is received. The scan 
rate of the paper recorder is matched to the pulse repetition interval of the acoustic 
beacon. This synchronizes the paper recorder, so that a new line is printed for each 
pulse repetition interval. The observer can note the relative change in travel time 
between successive beacon signals by comparing the locations of the corresponding 


marks on the recording paper. If the observer and the acoustic beacon are stationary, 
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the time it takes the acoustic beacon's signal to travel between the beacon and the 
observer is constant. For this case, the trace made by the paper recorder is a vertical 
line. As the observer approaches the beacon along a linear path, the range to the 


beacon, and consequently the time that the beacon signal takes to travel to the 





observer, decreases hyperbolically. The corresponding trace made by the paper 
recorder is also hyperbolic. The observer can use this relation to fix the acoustic 
beacon's position. To obtain a line of bearing to the acoustic beacon, the observer 
watches for the closet point of approach (CPA) to the acoustic beacon by noting the 
point where the trace produced by the paper recorder changes from negative to 
positive slope. This corresponds to the transverse axis of the hyperbolic trace and is 
the point where the range changes from decreasing to increasing. At the CPA, the 
acoustic beacon is located on a line of bearing perpendicular to the direction of the 
observer's motion. To estimate the location of the acoustic beacon, the observer must 
obtain lines of bearing from at least two different directions of motion. See figure 1-2. 
This method of passively locating acoustic beacons relies heavily upon the operator's 
skill in visually identifying the closest point of approach from the printed output of the 
paper recorder. Also, the observer is forced to travel in a straight line for a significant 
period of time until the CPA can be determined. Other factors that limit the 
usefulness of the above method are that paper recorders tend to be bulky, awkward to 
move, and require an adequate supply of expensive recording paper. 

This thesis examines the use of a single omnidirectional hydrophone in place of 
a conventional receiving array to efficiently localize an acoustic beacon using a 
nonlinear parameter estimation technique. The goal is to develop an inexpensive, 
easily deployed localization receiver that can interface to a personal computer for data 
analysis and signal processing. As a backup, this receiver must also perform the 


functions of the older paper recording system, using the personal computer as the 


10 





display device. 
1.2 Organization 
This thesis is organized into six chapters and three appendices: 
e Chapter I contains an introduction to the problem of passively localizing 
acoustic beacons. 
¢ Chapter II contains the development of a technique to localize a stationary 
acoustic beacon using a constrained Maximum Likelihood Estimator (MLE). 
¢ Chapter III contains an extension of the solution to the stationary acoustic 
beacon localization problem that allows for constant velocity, linear motion of 
the acoustic beacon. 
¢ Chapter IV contains results of Monte Carlo simulations of the localization 
algorithms developed in chapters II and III. The effects of using different 
effective sensor spacings and different numbers of experimental data points are 
explored. 
¢ Chapter V contains design criteria for a receiver to implement the algorithms 
developed in chapters II and III. A test receiver is designed and built based 
upon these criteria, and experiments are conducted to measure the actual 
performance of the receiver. 
¢ Chapter VI contains observations and concluding remarks. 
¢ Appendix 1 contains the schematic diagrams of the receiver designed in 
chapter V. 


¢ Appendix 2 lists the source code for the 68HC11 microcontroller used in the 


1] 





receiver designed in chapter V. 
¢ Appendix 3 lists the source code for the Macintosh computer used for data 


analysis and signal processing. 
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Chapter II 
Stationary Acoustic Beacon 
2.1 Introduction 
When the acoustic beacon 1s stationary, we are interested in locating the 
acoustic beacon to within a certain error bound as efficiently as possible. To 
accomplish this we treat the acoustic beacon's location as an unknown parameter 
vector, and formulate the localization problem as a constrained multiple dimension 
parameter estimation problem. To solve the constrained parameter estimation problem, 
we first develop a structural model that relates the values of a set of available 
measurements to the unknown parameter vector. We then define a residual error 
vector as the difference between the true values and the actual values of the 
measurements. Assuming the measurement errors are normally distributed, 
independent random variables, we define the likelihood function for a particular set of 
measurements as the logarithm of the joint probability density function of the 
measurements errors, viewed as a function of the residual error vectors. Next, we 
form a set of equality constraints by evaluating the structural model at the true values 
of the measurements, and the true value of the parameter vector 8. To find the 
maximum likelihood estimate (MLE) of the unknown parameter vector, we introduce a 
vector of Lagrange multipliers, and then define a Lagrangian function as the 
combination of the likelihood function and the sum of the equality constraints, 
weighted by the Lagrange multipliers. The maximum likelihood estimate is then 


found by determining the stationary point of the Lagrangian function. 
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2.2 Problem Geometry 

Consider the acoustic beacon to be at a fixed latitude, longitude, and depth. 
Since we are only concerned with locating the acoustic beacon in a small region of the 
Ocean, we approximate the earth as being flat in the region around the beacon's 
position and use a Cartesian coordinate system to describe the location of the acoustic 
beacon. The use of a Cartesian coordinate system does not contribute any significant 
errors as long as we correct for distortions due to the projection of the acoustic 
beacon's global coordinates onto the local Cartesian coordinate system. We define a 


parameter vector 9 as: 


G-= | xyz. |° (2-1) 
where x, represents the east-west position of the acoustic beacon, y; represents the 
north-south position of the acoustic beacon, and z, represents the depth of the acoustic 
beacon in meters relative to the center of the local Cartesian coordinate system. To 
correct for the distortions caused by projecting the acoustic beacon's global coordinates 
onto the local Cartesian coordinate system, we introduce a correction factor that is 
proportional to the cosine of the latitude. We then relate 8 to the acoustic beacon's 


global position by: 


degrees longitude - 60 Nm | 1853.2 m 
ies Fd 1 Nm 


0 = Yr = 60 Nm : 1853.2 m _ 
Z 1° 1 Nm - 
T 


- depth 


‘cos (degrees latitude) - Xp 


degrees latitude - 


(2-2) 


14 





where Xp and yp define an arbitrary reference point on the surface of the ocean which 

defines the origin of the local Cartesian coordinate system. In equation (2-2) we 

assume that the acoustic beacon's latitude and longitude are given in degrees. 
Similarly, we consider an observer on a receiving ship in the general location 


of the acoustic beacon. We define a measurement vector m,, as: 


m =([x, y, ty iE (2-3) 
where x, and y, are the receiving ship's coordinates on the same local Cartesian 
coordinate system defined for the acoustic beacon, and t, is the time that the observer's 
position x, y, was obtained. We use the same relation described in equation (2-2) to 
convert the receiving ship's global coordinates to local Cartesian coordinates. The 


measurement vector m, is then given by: 


60 Nm | 1853.2 m 


degrees longitude - ‘cos (degrees latitude) - x, 


xy 1° 1 Nm 
t 1° 1 Nm 
mr 

mn 


(2-4) 


Again, we assume that the receiving ship's latitude and longitude are given in degrees. 
Figure 2-1 summarizes the problem geometry. 

Now let us assume that the acoustic beacon transmits a signal at a regular 
interval, and that at time t, the observer receives one of the signals from the acoustic 


beacon. The time t, can be related to the time that the signal took to reach the 
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observer by: 


fe iy tT, ele (2-5) 


Here T, represents the acoustic travel time of the signal, T, is the time that the 
acoustic beacon transmitted the first signal, i is the number of pulse repetition intervals 
between when the first signal was transmitted and when the current signal was 
transmitted, and T, represents the pulse repetition interval. The product /-T, represents 


the time after T, that the acoustic beacon transmitted the current received signal. It is 
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assumed that the observer knows the pulse repetition interval of the acoustic beacon. 
The observer can therefore remove the dependance upon i-T, by counting the number 
of signals received (7), then subtracting 7-T, from equation (2-5). This synchronizes 
the observer's receiver with the pulse repetition interval of the acoustic beacon. We 
define the synchronized time of receipt as the time of receipt t, corrected to eliminate 


the pulse repetition interval of the acoustic beacon as: 


fea ee eT, tT, (2-6) 


and subsequently redefine the measurement vector m, as: 


m =a, ¥, &. | ie (2-7) 
The difficulty in passively ranging an acoustic beacon arises because the 
observer does not know T,, the time the acoustic beacon started to transmit. In active 

ranging systems, the observer can measure T, directly by transmitting a signal at a 
known time T,, and measuring the time that the corresponding reflected signal from a 
target is received. In passive ranging systems, the observer does not know when the 
beacon signal was transmitted and therefore the observer has no time reference T,. 
Consequently the observer has no way to directly calculate T,. In order to passively 
range a target, the observer must eliminate the dependence on the absolute time 
reference T,. 

2.3 Structural Model 


In order to proceed, we must develop a model which relates the measurement 


vector m,, and the unknown parameter vector 8. We define a function f(m,, 0) 


eg 





which relates the distance between the acoustic beacon's position 8 and the receiving 


ship's position x,, y,, to the synchronized time of receipt t,,, as: 


COE Cue ae: (y,- V7) cr — CC; f,,,) (2-8) 


where t(C, t,,) is a function that relates the speed of sound in seawater to the 
measured time of receipt, synchronized to the pulse repetition interval of the acoustic 
beacon. It is assumed that the receiving ship ts on the surface of the ocean, or 
equivalently z, is zero. Using a homogeneous ocean model and a direct path 


propagation mode for simplicity, we can define t(C, t,,) from equation (2-6) as: 


Cae) IC -Tmtc CT, (2-9) 


Sp oO 


Substituting equation (2-9) into equation (2-8) yields: 
f(m,, 6) = (x, =x) f (Y, - yn) + Zp ~ Oe C:T) (2-10) 


It is apparent from equation (2-10) that we can not eliminate the dependence 
upon T, with only one received signal from the acoustic beacon. One way around this 
problem is to compare the time of receipt and positions from two separate received 
signals. This is commonly referred to as range difference, or time difference ranging. 


We define a new function g(m,, m,, 9) as: 


g(m,, m,, 9) = f(m,, 6) -f(m,, 6) (2-11) 


Substituting equation (2-10) into equation (2-11) with m, for the first received signal 


and m, for the second received signal we have: 
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&(m,, Ms, 0) ms y (x, - Xp) + (9, - Ye) + 2p Tce 
2-12 
“Y Ghose Ghar as +... 


ct Cae eit 8, 


The first two terms of the function g(m,, m,, 9) represent the slant range between the 
acoustic beacon and the receiving ship at the two separate times that a beacon signal is 
received. By subtracting one range from the other, we are left with the distance that 
the observer moved radially, relative to the beacon, between the times t,, and t,,. This 
is known as the range difference between the two points given by m, and m,. The last 
term of the function g(m,, m,, 8) represent the range difference between points m, 
and m, calculated from the time difference. From the last term of g(m,, m,, 9) we see 
that the dependence upon T, 1s eliminated, and we are left with a model that relies on 
measuring the time of receipt, synchronized to the pulse repetition interval of the 
acoustic beacon, and the location of the receiving ship at the time of receipt. 

To simplify notation, we define an experiment to be the augmentation of two 
measurement vectors m, and m,, and use the notation: 


2-13 
Va =E% Mm by % He bo ee) 


We then redefine the equation (2-12) as a scaler valued function of the experiment 


vector w, and the acoustic beacon location vector 8: 


g(w,, 9) = g(m,, m,, 9) (2-14) 


We 








We denote the function g(w,, 0) as the structural model of the parameter estimation 
problem. Ideally, if the measurements have no errors and 7(C, t,,) 1s the correct 
propagation model, g(w,, 0) equals zero at the true value of the parameter vector 0. 
The estimation problem is then to determine the value of the parameter vector 9 that 
minimizes the value of the structural model given experiment vectors which contain 
errors. 
2.4 Measurement Errors 

The structural model describes the ideal situation - perfect measurements, free 
from any errors. In reality both the synchronized time of receipt t,, and the positions 
X,, y, have errors associated with the measurement process. We can define the actual 


measurements as the sum of the true value and a random error component: 


dS 
+ 


< 
+ 
Si 


wemewel|  * (2-15) 


where x,, y,, t,,, and w, represent the true values of the measurements, and X,, Y,, 

t,,. and w, represent the random errors associated with the measurement process. 
With the assumption of a homogeneous, direct path propagation mode, and 

since the time of receipt will be determined by looking at the output of a simple 


digital peak detector, the errors in measuring t,, arise mainly from the sampling of the 


received signal. Because we use a simple peak detector to measure the time of 
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receipt, we can only estimate the true time of receipt to within one sampling interval - 
if we sample the received signal every millisecond, then we can only know the time of 
receipt to within 1 millisecond. This quantization of the time base causes the 
measurement errors to have a uniform distribution centered around the true value t,, 


with a variance given by: 


aoe 5 (2-16) 


where T, is the sampling interval in seconds. For the sake of computational efficiency 
and mathematical tractability, we would like to model the measurement errors of t,, as 
zero mean, normally distributed random variables. If we consider that the structural 


model is not exact (a far more complex function t(C, t,,) is needed to have an exact 


st 
structural model), and that there will be errors due to factors such as dispersion and 


multipath interference, we can lump the modeling errors of t(C, t,,) together with the 


spt 
quantization errors in the time t,,. Although not strictly rigorous, this allows us to 
simplify the development of the solution to the localization problem by assuming the 
measurement errors of t,, are zero mean, normally distributed random variables, with a 
variance approximated by Ga: Also, since the measurement of the time of receipt of 
one signal is not effected by the measurement of any other time of receipt, we can 
take the errors in measuring t,, as independent between t,, and t,,, and also 
independent between experiments w.,,. 


Errors in measuring the ship's position at the time of receipt of the beacon 
g ps p p 


signal are due to the accuracy of the system used to obtain the ship's position. To 
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obtain the ship's location, a Global Positioning System (GPS) receiver will be used. 
Other navigation systems such as Loran, Omega, or even Inertial Navigation systems 
could be used, however the price and accuracy of the GPS system make it the natural 
choice. Currently, inexpensive commercial C/A code GPS receivers are available with 
published errors on the order of 25 meters rms in latitude and longitude. The more 
accurate Differential GPS and P code receivers are not readily available at this time. 
We will assume that the errors of the GPS positional data are normally distributed, and 
independent in latitude and longitude. This assumption is unlikely to cause much 
harm as long as the true probability distribution of the errors have smooth tails [Bard 
1974]. 

With these arguments in mind, and for the sake of computational efficiency and 
mathematical tractability, we model the measurement errors as zero mean, normally 
distributed, independent random variables. We take the covariance matrix of the 


measurement errors as: 


070 0 0 0 0 
} 
0 a7 0 0 0 0 
3 
DC of OF Oo 
vee ‘ (2-17) 
[0 w0r=0 G7 0 0 
rv} 
0 0 0 0 a? 0 
p 
2 
;9 0 0 0 0 g, 


Where o,,” is the variance given by equation (2-16), 6,” is the variance of the GPS 


longitude error in meters, and oh is the variance of the GPS latitude error in meters. 
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2.5 Parameter Estimation Solution - Maximum Likelihood Estimator 

To solve for the parameter vector 8 we would normally use a weighted least 
Square approach. However, because of the nonlinearities in the structural model 
g(w,,. 9), and because all of the measurements have errors, the weighted least squares 
method does not work well. To demonstrate why the normal weighted least squares 


method does not work well, we look at the contours of the y* merit function: 


ie " ( a(m,, 8)) (2-18) 
m 

If the structural model is truly exact, and there are no measurement errors in w,, 
g(w,,, 9) and x” are equal to zero for the true value of 8. As the value of 8 in 
equation (2-18) moves farther away from the true value of 8, the y’ function 
increases. Figure 2-2 shows the contours of the y’ function for the true values of the 
measurements w,, where the acoustic beacon is located at x; = -1000, y; = 1000, and 
z, = -1000. From Figure 2-2 we see that the contours of the x” merit function that 
encircle the true position of the acoustic beacon are highly eccentric. This eccentricity 
leads to large variances in the location estimate along the major axis of the ellipse. 
With errors in all of the measurements, this in turn produces errors in the parameter 
estimates that are unacceptable. 

To overcome the difficulties in solving the parameter estimation problem with a 
nonlinear structural model and errors in all of the measurements, we treat the problem 
as a constrained minimization problem. Our goal is to estimate the true values of the 


measurements w, given a set of n equality constraints which we obtain by setting the 
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Figure 2-2 Chi Square Contours for the Normal Weighted Least Squares Method 


structural model g(w,, 9) equal to zero at the estimated true values of the 
measurements and the estimated parameter vector 8. Because of the measurement 
errors, we must modify the structural model to indicate the dependence upon the true 


values of W,,: 


g(W,, 0) = (4,-xp) + (9, -yp tae te 
- (4,- Xp) + (H.-Y)? + 2p + Cr 


-C ° ( bey y t.») 
Next we define a residual vector as the difference between the true value and the 


observed value of the measurements: 
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ey ( W,, ) = he Ne (2-20) 


We also define a composite experiment vector W as the augmentation of ” experiment 


vectors Wi: 


W=[w wm. Wy i (2-21) 
With the assumption that the measurement errors are normally distributed 
random variables, independently distributed between experiments, and with the further 
assumption that the covariance matrix is the same for each experiment, the likelihood 
function takes the form: 
log (L(W, V)) = -(n/2) log (det V) -5 2 e, Vas ee (2-22) 
“= 
where n is the number of experiment vectors w, used in the estimation problem [Bard 
1974]. The maximum likelihood estimate is found by determining the value of 0°, and 
the value of w, for each of the n experiments, which minimizes log(L) while satisfying 
the n equality constraints imposed by the structural model. The terms w, and 9° 
represent the maximum likelihood estimate of the true values of w, and 0. 
To find the maximum likelihood estimate given the n equality constraints 
imposed by the structural model, we introduce an n-dimensional vector of Lagrange 


multipliers 4, for each experiment. We then form the Lagrangian function: 
x e n 
ACW, 6, V, A,,..4,) = log(L(W, V))+ Do Maen) ees 
p= 
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The solution to the estimation problem will be found at a stationary point of the 
Lagrangian A(W, 0, V, A,, ..., A,) [Bard 1974]. 

To demonstrate the benefits of using this approach, we look at the contours of 
the Lagrangian function given by equation (2-23). Using the algorithm developed in 
section 2.6, figure 2-3 shows the contours of the Lagrangian function obtained by 
using the same experiment vectors used to generate the contours of the normal 


weighted least squares method. 
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Figure 2-3 Contours of the Lagrangian Function A 


From figure 2-3 we see that the contours that surround the true position of the acoustic 
beacon are much less eccentric then the contours of the normal weighted least squares 


method. Therefore, we do not have the large variances associated with the niajor axis 
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of the normal weighted least squares method, and the estimate of the parameter vector 
8 will be more accurate. 

To solve the maximum likelihood estimator problem given the equality 
constraint of the structural model we use an iterative method suggested by Deming as 
described by Bard [Bard 1974]. We define the parameter vector 0; as the estimate of 


the acoustic beacon's location at the ith iteration: 
ae ptt * * * 17 ~ 
0; Sl Ar, Way <r ] (2-24) 
We also define the estimated true experiment vector at the /th iteration as: 


a *£ _ a * Sem a * a « f * 47 - 
WwW, =U4, Wi, 1, %, Ye, be, I ae) 


and the corresponding composite experiment vector: 


cs eT 
ae re (2-26) 


i i 


The vector W, is the augmentation of the n estimated true experiment vectors W,, at 
the ith iteration. We then define a composite vector valued function G(W, , 9;) where 


the jth component of G(W, ,8.) is the structural model evaluated at (w,, 0°): 


G(W,’, 0," ) 7: G, a [3 (wy, 6,”) 8 (Ww, "; 0.") oe g(™,.'; Ge yae 


(2-27) 


Next we define an objective function as the weighted least squares sum of the 


pas 





residuals given by equation (2-20). At the ith iteration the objective function ts: 


4, 1 a = ae ais 
eS 2 (Wy, ie Vi We), See ed 
ie 


This is the same form as the last term in equation (2-22). To solve for the Maximum 
Likelihood Estimate, the objective is to find the W, which minimizes log(L), or 
equivalently, P(W, ) subject to the constraints G(W, , 9.) = 0. We note that now the 
unknown parameters that we are estimating are the acoustic beacon's location as well 
as the true values of all the measurements. 


To develop a solution, we define the following terms: 


q, = O®(W, )/aW (2-29) 
H, = P®(W, )/awow (2-30) 
A, = 0G(W,, 6;)/aW (2-31) 
B, = 9G(W,, 8; )/98 (2-32) 


Next we expand the objective function in a Taylor series around the current estimate 


of W and 8. Keeping only up to the second order terms we have: 


&,(5W) = 0,497 8W + 8W7H, SW (2-33) 


Now we expand the structural model in a Taylor series around the current estimate of 


W and 9. Keeping only the first order terms we have: 
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G,(5W, 50) = G,+A,5W+B, 30 (2-34) 
To find the maximum likelihood estimate we now want to find the 6W and 50 
that minimize © while at the same time satisfies the structural model constraints 


G, = 0. To do this we introduce the vector of Lagrange multipliers A and look for the 


Stationary point of the Lagrangian: 


A.(8W, 80, 4,) = ®.(8W) +A; G, (2-35) 


Forming the normal equations of the Lagrangian and using equations (2-33) and (2-34) 


we have: 


OA,( dW, 86, 4,)/0(6W) = ¢,+H,bW+A; A, = 0 (2-36) 
dA,(8W, 86, 4,)/ 9A, = G,+A,bW +B,60 = 0 (2-37) 
dA.( SW, 80, 4,)/0( 80) = B; A, =0 (2-38) 


From equation (2-36): 


aA 


SW = -H; -(q,+A; A.) (2-39) 


Substituting equation (2-39) into equation (2-37) we have: 
G,-A,H; q,-A,;H; A; A,+B, 50 = 0 (2-40) 
Solving for A.: 
A, = (A, Hy’ AT) + (.B, 80 -A,H;' 4; + G,) (2-41) 
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Now substituting equation (2-41) into equation (2-38): 


Bi: (A,H;'A,) "+ (B,80-A, H; q,+G.) = 0 (2-42) 


Solving for 50 we are left with: 


56 = (B; -(A,H, A; )"-B,)" -B;+(A;H; A; )" (A, H; q;~ G;) 


(2-43) 
We can define a new term C, as: 
C, = A, H; A; (2-44) 
and a term D. as: 
D, = B; C; B, (2-45) 
Substituting equations (2-44) and (2-45) into equation (2-43) gives: 
80 = D; B,C; -(A,H; 4, - G) (2-46) 


Once we have calculated 60, we use equation (2-41) to calculate the 
Lagrangian multipliers which in turn are substituted into equation (2-39) to calculate 
the updates to the true measurements. Equations (2-39) and (2-46) then allow us to 
iteratively calculate the estimated beacon location and the estimated true values of the 


measurements with the recursion relations: 


ae) 
+ 
iI 


0° .+ 66 
(2-47) 


= 


W'+dW 
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All we need to start the calculations are initial values for 8° and for W". Since the 
measurement errors are presumably small, we can use the actual measured values W 
for the initial values of W’. However, since we have no idea of the location of the 
acoustic beacon, the choice of an initial value for 8° is more difficult. In the absence 
of any other information, we can choose the center of the search area for the initial 
value of 0°. 

In developing the solution to the maximum likelihood estimate we made the 
assumption that the measurement errors are normally distributed and independent 
between experiments. To determine if this is valid we refer back to the source of the 
measurement errors. The measurement error f,,, is not normally distributed. However, 
if we do not make the assumption of a normally distributed error, and stay with a 
uniform distribution of errors, we will be unable to use the maximum likelihood 
method. This 1s because likelihood methods use gradient techniques to maximize a 
likelihood function which is based upon the probability distribution function of the 
errors. If the underlying probability distribution function 1s not smooth and 
continuous, there will not be a unique maximum, and a useful estimate can not be 
found. This means if we stay with the uniform distribution we will be forced to use a 
more computationally expensive direct search of the parameter space, or minimax 
method to estimate the acoustic beacon’s location. 

As a result of the uniformly distributed errors in t,,, the solution that we obtain 
from the maximum likelihood estimator is suboptimal. There is also a chance that the 


method used to find the estimate that maximizes the likeliness function will diverge. 
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This happens when the estimate of the true value of t,, is further away from the 
actual true value of t,, then the quantization of the time base allows. To prevent the 
solution from diverging, we can place additional constraints upon the minimization of 
the objective function that confine the solution to be within a feasible region. We 


define the feasible region to be the region bounded by the inequality constraints: 


- Range... < *7 < Range... 
-Range,,,. < Yr < Range... (2-48) 


-Depth,,,. $ 2, < 9 


Where Range... defines the size of the search area that we are willing to scan, and 


max 
Depth, 1s the maximum depth in the area of the search. The beacon's depth is 
bounded above by the sea surface level. If the solution to the maximum likelihood 
estimator is within the feasible region, we accept the estimate. If, however, the 
solution to the maximum likelihood estimator is outside the feasible region we must 
adjust the estimator to bring the solution inside the feasible region, or in the worst 


case, disregard the estimate. 


To maintain a feasible solution we break equation (2-47) into component parts: 


0*,,, = 0°,+ 60 = 0°,+p,U, 
(2-49) 


WwW w+ SW = W’+p2Uy 


i+] 


where U, and US are unit magnitude vectors that describe the direction of 50 and 
5W, and p, and p% are the magnitudes of 56 and SW. We assume that 50, and 


hence Ug, points in the proper direction to the maximum likelihood estimator. If 
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9;+ 66 is outside the feasible region defined by equation (2-48), we find the 


maximum value of p which satisfies: 


~Range, ax Range nox 
-Range. a. < ah + P nar 9 < Range vax (2-50) 
Depth wax 0 


Once we have found 9,,,, we replace py and py, in equation (2-49) which gives the 


new update equations: 


cD 
+ 
i 
cD 
+ 
+ 





Ke 
i+] é — U, 
2 


(2-51) 


: = Peas 
W. =W +— Uy, 


i+] i /2 


This essentially shortens the step that we move in updating 8° and W’ for the iteration. 
Notice that we do not simply replace p, and py with p,,,.. If we did this, 8;,, would 
be on the edge of the feasible region. With 0,,, on the edge of the feasible region, 
Pmax Will be zero, and 0;,, will equal 0; for all subsequent iterations. If this happens 
we will be unable to achieve any further updates of 9;,, and W;. It is still possible 
that, after a certain number of iterations, 0°. lies on the edge of the feasible region. If 
this happens we must reject the estimate and try again using a different initial value 
for 8° or more experimental data points. 
2.6 Algorithm 

Figure 2-4 at the end of this section describes the algorithm used to estimate 


the location of the acoustic beacon based on Deming's method as described by Bard. 
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There is no natural way of telling whether or not progress towards the solution has 
occurred in any given iteration when we use this method [Bard 1974]. Bard suggests 


calculating the quantities: 
n 
= ae *.\T - a ¢ “4 = 
p= 


and: 


Z, = D, 84 Ww, +8¥,, 0; +80)" c.g. (vw, *+8w,, 67480) (2-53) 


The rational behind these quantities follows that at the true values of W and 6, 


G(W, 9) must equal zero. If Q is a positive definite matrix, we require that: 


G (Wry Bi)” Q, GW, Oi) s ECW, 0;)" Q, GW, 87) 2-54) 
This means that as W, and 0, approach the true values of W and 0, the quantity 
G(W;, 9;)' Q, G(W;, 8;) must decrease. The natural choice for Q, is the inverse of 
the covariance matrix of G(W;, 6;) [Bard 1974]. With V, as the covariance matrix of 
the measurements, the covariance matrix of G(W,, 9,) is approximately: 


COV (G(W,;,8;)) = > a, V, a,” (2-55) 


p=l 


Now from equation (2-30) we have: 


V0. «=©=©60 


-1 
H, =? 0(W’)/aWow = M2 (2-56) 
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So we choose: 


. -1 
ae 8 eS - -] - 
Q, = COV(G(W, ,6; ))” [S4, Vu 2, =(A, H A; ) =i 
(2-57) 


It then follows that: [Bard 1974] 


n 
a *\T a * a « * - a 8 : 
ir 
(2-58) 
If Z, is less then Z,, we accept 50 and SW and continue to the next iteration. If Z, is 
greater then Z,, we shorten 50 and 5W and then recalculate Z,. 


To determine when to stop the algorithm we follow the termination criterion of 


Marquardt [Bard 1974]. We define a tolerance: 


3, = 10*-([6; |... + 10°) (2-59) 


where | 9; |_;, is the smallest component of 8;. The term 10° is added in case 
| 6; |.., is close to zero. For each iteration we check to see if | 50 = is less then 


s. If 150 |. is less then €., we terminate the algorithm. If 156 |... is not less 


min 
then €, we continue. For each iteration we calculate a new tolerance value €,. This 
leads to a conservative termination criterion that will stop the algorithm if the 


parameter values cease changing. 


To start the algorithm we choose an initial guess of the location of the 


aS) 





acoustic beacon, she We then use the measured values of W for the initial values of 
W... For each experiment u, we calculate: 


—- wt 
a=, Ww 


; (2-60) 


Ty 
a, = 08, | ow (2-61) 


b, = dg, / 00 (2-62) 


For the case of the stationary beacon a, 1s given by: 


(4; = x7) 
Qi - sr) + - Yet (Zr)? 
(3) - yr) 
(fy - xp) +(9, - yr) + (2p? 
-C 
Co (2-63) 
(4, - xp) 
(43 - xp) +(Io - Yr)” + (Zp)? 
(Jo - Yr) 
(fy - xp) +(Sy - Yr) + (Zp? 


HC 


and b, is given by: 
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(<5 2 Be 7 CH - i) 
(f5- xp) +(So- yr) H(z)? - xp) - yp)? + (zp)? 

(¥.- yr) a (y, - yr) (2-64) 
(5 - xp )+(92 - ye) t(ze VR - ep) - yp)? + (2p )’ 


Ps 


bie 7 £T 
\(G,- xe HH Vet (Zp)? a - Xp )?+(a - Yr) + (Zr) | 


Once we have a, and b,, we calculate: 





=A fF 2-6 

Cena Ae (2-65) 
n a #* * \2 

>> eas (2-66) 
p=l Cu 


and: 


{1 
D = —|°b bb? (2-67) 
Using equation (2-46) we can solve for 60: 
ila 2 Fa (4,7 en 8(W,", 8°) ) by Ge) 
p=1\"p 


Now using equation (2-41) we calculate the Lagrangian multipliers: 


= 1 i T = T A # * = 
A. = fa (b, 60 - a," e+ g(w,", 0 )) _ (2-69) 
rn 


oy 





and finally we calculate: 
OW eaertan AVG (2-70) 
Once we have 50 and 5W we check to see if 0;+ 80 is in the feasible region. If 


§.+ 50 is not in the feasible region, we adjust the step size of 50 as describe earlier. 


Once we have a feasible step for 50, we calculate: 


wi+Ow,, 6*+80) 


Zz, = ys (" (2-71) 
2 


Cu 


If Z, is less then Z,, we accept the values of 80 and SW and update 0 and W’ using 
equation (2-47). We then move to the next iteration. If Z, is greater then Z,, we 
assume that we have overshot the maximum likelihood estimate, shorten 50 and 5W 
by a factor of two, then recalculate Z,. We continue this process until Z, is less then 
Zy, or until 60 is negligible, at which point we have to stop the algorithm and begin 


again with a new initial value for 9°, or more experimental data points. 
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2.7 Accuracy of the Estimation 

One of the benefits of using Deming's method for the maximum likelihood 
estimate is that the covariance of the estimated parameters 1s approximated by the 
inverse of the matrix D defined by equation (2-45) [Bard 1974]. This lets us quickly 
determine if the estimation of the acoustic beacon's position is acceptable, or if more 
experimental data needs to be collected to improve the estimation. We are also able to 
test if the assumptions made regarding the covariance matrix of the measurement 
errors are valid by examining the final residual vectors. We define a moment matrix 
M as: 


n 
M=) ee!” (2-72) 
p=l 


where the e, 's are the final residual vectors. To estimate the covariance of the 


residuals we take: 


a? 


y-_©9 .y (2-73) 
n=3 


where 7 is the number of experiment vectors used in the maximum likelihood 
estimation. Because of the nature of the constrained minimization problem, the first 
term in equation (2-73) is needed to correct for bias [Bard 1974]. We can compare 
the outcome of equation (2-73) to the assumed covariance matrix V, defined by 


equation (2-17) to see if the estimated covariance matrix V,, is valid. 
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2.8 Summary 

In this chapter we have developed the maximum likelihood estimate of the 
acoustic beacon's position, and a means in which to gauge the accuracy of the 
estimation. To estimate the beacon's position we defined a structural model that 
requires the observer to measure the time of receipt and location of receipt of two 
different signal from the acoustic beacon. The choice of how far apart the two signals 
that define an experiment vector (w,) must be, and the number of experiment vectors 
to use in the parameter estimation problem (n) remain as free parameters. In chapter 
IV we examine the performance of the algorithm of this chapter for different choices 


of these two free parameters. 
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Chapter III 
Moving Acoustic Beacon 

3.1 Introduction 

In chapter II we developed the maximum likelihood estimator for a stationary 
acoustic beacon. In this chapter we extend the solution to include a moving acoustic 
beacon. The task of localizing an arbitrarily moving acoustic beacon is quite difficult. 
Abrupt changes in the acoustic beacon's velocity are difficult to parameterize and 
model. Therefore, we concentrate on the case of an acoustic beacon which moves in a 
constant velocity, linear path. The assumption of constant velocity, linear motion is a 
reasonable assumption for acoustic beacons located on instruments ascending at 
terminal velocity from the bottom, or for acoustic beacons located on instruments 
moving with an ocean current that is steady in the area of interest. With the 
assumption of constant linear motion, we modify the structural model given by 
equation (2-19) to include parameters that reflect the acoustic beacon's velocity. Once 
the new structural model is defined, we show that the solution to the maximum 
likelihood estimate for the moving beacon follows directly from the solution to the 
maximum likelihood estimate for the stationary acoustic beacon. Next, the algorithm 
developed to solve the stationary acoustic beacon localization problem is extended 
using the new structural model so that the position and velocity parameters of the 
moving acoustic beacon can be determined. Finally, the accuracy of the estimator is 


examined. 
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3.2 Problem Geometry 
Consider an acoustic beacon having constant velocity components given by 


V,, Vy, and v,. We define a new parameter vector: 


x T : 
Ouanley, Vy ezeey. Ve. V, (3-1) 


where the coordinates x,, y,, and z, define the acoustic beacon's initial position on the 
same Cartesian coordinate system that was described in chapter II. For convenience, 
we assume the velocity components v,, v,, and v, have the units of meters per second. 


The position of the acoustic beacon at an arbitrary time t, can by found using: 


Sie x v 


oO x 
Yr | =| ¥ | + (ty-T,) Yy (3-2) 
<r Xo ie: 


where T, is the reference time that corresponds to the acoustic beacon's initial position 


Xo» Yo» Zo. 


As in chapter II, we define a measurement vector m,, as: 


= rT 3-3 
m =[x, y, &,] (3-3) 
Where x, and y, are the ship's coordinates, in meters, on the same local Cartesian 


coordinate system defined for the acoustic beacon, and t,, is the synchronized time of 


receipt that corresponds to the observer's position x,, Y,. 
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3.3 Modified Structural Model 
To account for the linearly moving acoustic beacon, we redefine the function 


f(m,, 9) from chapter IT as: 





fly, OY =y Ry %o-Up TVs] Vu Yo Up “TI gf too tp -T)¥,) 


7 1 ( C, ae, 


(3-4) 


where t, represents the time that the acoustic beacon transmitted the signal that the 
observer received at the synchronized time of receipt t,,. Using the same 
homogeneous ocean model, and direct path propagation from chapter II, we simplify 


equation (3-4) to: 





Kim,, 8) = [x,,-*,-(t -T,) v,) HY, Vo (tg -T,) vy +z, +(t, -T,) v,) 


- C(t,,-T,) 


(3-5) 


Now assume that at time T, the acoustic beacon transmitted the first signal that the 
observer receives. To find when the current signal received at the synchronized time 
of receipt t,, was transmitted, we note that the acoustic beacon transmits a signal for 


every pulse repetition interval. With T, as a reference, t, can be found by: 
2 7 3-6 
jy 1 Ge (3-6) 


where T, is the pulse repetition interval of the acoustic beacon and i is number of 
pulse repetition intervals that separate the signal transmitted at time t; from the signal 
transmitted at reference time T,. To determine i, the observer counts how many 


signals are received between the first received signal and the signal received at the 
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synchronized time of receipt t,,. Simplifying equation (3-5) to eliminate T, and t,, we 


substitute equation (3-6) into equation (3-5) which yields: 


fim,, 9) = 





@,,-x,-t Tv) +), -y,-1-T, -v,)+(2, ti -T,-v,)” a 


mae (sy =e) 
Now, just as in the case of the stationary acoustic beacon, we must eliminate the 
dependence on the time reference T, from the last term in equation (3-7). 
To eliminate the dependence upon the time reference T,, we define the function 


g(m,, m,, Q) as: 


8(m,, m, 0) = f(m, 0) -f(m,, 8) (3-8) 


Substituting equation (3-7) into equation (3-8) with m, for the first received signal and 


m, for the second received signal we have: 





8(m,,m,, 8) = (%,-x,-t-T,° vy +(y,-y,-i we vy +(z, +i = ava 


(3-9) 





“+S '°T, ‘v.)"+(y>-y,-/ 2 vy) +(Z, sd a v,)? 
~ © (6,1 ~ b9) 
Simplifying notation as in equation (2-13), and showing the dependence upon the true 


value of the measurements, we define the structural model for the case of the moving 


acoustic beacon as: 
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BUM 5 BD) = Ce Om es ee cos ay Pn 


(3-10) 





SV Comite Nae ay J Ievyea(z.aj tev.) 
-€ Ge t.2) 
This is analogous to equation (2-19) with additional terms included to correct for the 
beacon's motion. 
3.4 Maximum Likelihood Estimator Solution 
The solution to the maximum likelihood estimation problem for the case of the 
moving acoustic beacon follows directly from the solution to the maximum likelihood 
estimation problem for the case of the stationary acoustic beacon. Since only the 
structural model has changed, the likelihood function log (L (W, V)), the Lagrangian 
function A(W, 8, V, A,, ... ,A,) and the objective function ®( W,) all have the same 
form as the corresponding functions defined for the stationary beacon. To solve for 
the maximum likelihood estimator of the parameter vector 8, we simply substitute the 
modified structural model given by equation (3-10) for the stationary structural mode 
given by equation (2-19), and follow the method of Deming described in chapter II. 
There are, however, a few differences that must be accounted for. 
If the measurement errors are the same for both cases, we still expect the 
solution to the maximum likelihood estimator to be suboptimal. Because of the 


uniform distribution of the measurement errors f... we must continue to confine the 


sp? 
solution of the maximum likelihood estimation problem to a feasible region. With the 


addition of the parameters v,, v,, and v, to 8, we expand the feasible region defined by 
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equation (2-48) to: 


-Range,.., < *) < Range... 
-Range, ax SY, < Range... 
-Depth,,, < 2 < 9 


(3-11) 


-V sv. SV 


*max * *max 


yes Ss Vy Ss Vena, 


a nS Ss 
ae “i yee: 


As in chapter II, to maintain a feasible solution, we break 60 into component parts: 


G;., = 0; +56 = 6; +p, U, (3-12) 
where U, is unit magnitude vector that describes the direction of 60, and ps, is the 
magnitude of 60. We assume that 50, and therefore U, , points in the proper 
direction to the maximum likelihood estimator. If 8;+ 50 is outside the feasible 


region defined by equation (3-11), we find the maximum value of p that satisfies: 


— Range vax Range... 
- Range, vax Range na 
-Depth,,.. 0 
* 3-13 
“ve < 6; TS U, < Ve ( ) 
“Vy Vs 


Once we have found 9,,,,, we define the new recursion relations: 
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Oe = 6; 5 P max U, 
y2 
(3-14) 





Ap 
Wn Vi ep 


b+ 2 


As with the case of the stationary acoustic beacon, if, after a few iterations, 0, lies on 
the edge of the feasible region, p,,, will be zero and 0;,, will equal 6; for all 
subsequent iterations. If this happens we reject the estimate, and try again using a 
different initial value for 8° , or more experimental data points. 
3.5 Algorithm 

Figure 3-1 at the end of this section describes the algorithm used to solve for 
the acoustic beacon's position and velocity. The algorithm is essentially the same 
algorithm developed in chapter II with changes made to account for the modified 
structural model of equation (3-10). Because of the modified structural model, we 
must reevaluate the quantities a, and b, From equation (3-10), we define the 


quantities: 








d, = (Qa. ET, ve P +r -y0 ET, YP + HT, 12) 

(3-15) 
dy = [Gp -a5 FT, Ve) 02-6 TT, YP HG TT, VP 

(3-16) 


a, and b, are then given by: 
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a, = dgw,", O° )/ow, = a) 
Ce ae) 
d, 
(2° -Y, Bich. vy) 
d, 
C 


b, = dg(w,*, 0° )/ a 


Comer hoi a(t, <4, <I Tv,» 
d, d, 


Crees Oi oent 2) 
d, d, 





(eo i-T,-¥e) (ee +h-T, Ye) 
d, d, 


ee, Joly tia xX, 21 -Ve ) 
d, d, 

De Opeyietnw)) tT) 9, EV, ) 
d, d, 


HEI Ga Sele ve) - Ge Ey ‘T, Ys) 
d, d, 


(3-18) 
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To evaluate the structural model, and the terms a, and b, ,we need to know the 
values of i and j that represent the time that the received signals were transmitted. 
This forces the observer to keep a count of the number of signals that are received, 
with the first received signal corresponding to i = 0. 

Once we have found the maximum likelihood estimate of the parameter vector 
0, we need to evaluate the estimated current position of the acoustic beacon. The 
position defined by x, , y,, Z, is the estimated initial position of the acoustic beacon 
at the time T,. We assume that the time T, corresponds to the casei = 0. To 
determine the current position of the acoustic beacon, we project the solution forward 
along the path described by the estimated velocity components v,’, v,, v,. The 


estimated current position of the acoustic beacon 1s then given by: 


ee sed Vv, 

* = e * 3- 19 
Lime | = | Le a I, Vy ( 
LT Xo Vz 


where / is the total number of beacon signals received and T, is the pulse repetition 
interval of the acoustic beacon. The quantity (i - T,) represents the time it took to 


collect the measurements used to calculate the maximum likelihood estimator. 
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3.6 Accuracy of the Estimator 

To estimate the accuracy of the solution to the maximum likelihood estimator, 
we examine the estimated covariance matrix of the parameter vector 8. As with the 
stationary beacon, the estimated covariance matrix of the parameter vector 9 is given 


by the inverse of the matrix D or: 


= 
Vv; : ( BTC“ B ja! e | fe -b, b, | (3-20) 


p=1 Cu 
The variance of the velocity components v, , ve and v, are the last three diagonal 
elements of the covariance matrix V4. 


To determine the variances of the current acoustic beacon position estimates we 


calculate: 


one = E| ((x, +i, v,)-E[x,+i-T, ¥, |)" (3-21) 
Oy = El (I+ ET, %y) - E[Yo* ET, Yy))"] is 
Cnc tT viz ni y.|\a| (3-23) 


Simplifying equations (3-21) through (3-23) yields: 


eC (10 i Ak (lu JOP 


(3-24) 
~ E[ xf -2(E-7, )E[%. ]E[%0] -(#T, El 


7 Ely} ~2°(ET, )E[Y, JE yo] (bt, E[¥% Vr 
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CraeC men (aebled, aee2 (TRE y, v, | wae 





ne, |, * 28-1, )F [2] 


(3-26) 


z 


~ E[2f -2-(-7, El, JE [20] -(#°7,"E[¥, J) 


Now if we assume that the estimate of the parameter vector 9 is unbiased, we can 


substitute the estimated parameter values for their means in equations (3-24) through 


(3-26). This gives us a method in which to calculate the estimated variance of the 


projected current position: 


4<T 


wr 


= 6 ang fe) 2c 2+ 2-(i-T, )E| x, v,] 


a vy, P ae (3-27) 
~ BoP -2(ET, ve ao ~(7T, ve 
= 0,7 + LEI 2G + 2-(0-T, EY, vy] (3-28) 
5) . + A *\2 
— (We) -2(E-T, %y Vo -( ET, | 
7 0, , (i-T, +0,” A 2-(i-T, Elz, v,| (3-39) 


* : * * 4 * \2 
= (GaSe Se SLR Fon ae i) 


From equations (3-27) through (3-29) we see that the variance of the estimated current 


position has a complex relationship to the number of experiment vectors used and the 


effective sensor spacing. As these quantities increase, we expect that the variances of 


the estimated initial positions and velocities will decrease. However, as the number of 


experiment vectors used and the effective sensor spacing increases, the term 7 will 


increase and the variance of the estimate of the current position of the acoustic beacon 


can also increase. This is because if we project the initial position of the acoustic 


beacon forward based on the estimated velocity parameters, any errors in the acoustic 
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beacon's velocity causes us to move the estimate in the wrong direction. The choice 
of how many experiment points to collect, or how long we spend collecting data 
points, will be examined in chapter IV. 

As with the stationary beacon, we can test the assumptions made regarding the 
covariance matrix of the measurement errors. We define the moment matrix as: 


n 
as ee 3-30 
M 2, Canes (3-30) 
p= 


where the e, 's are the final residual vectors defined as in chapter II. To estimate the 


covariance of the residuals we take: 
~ 6 
Bo Oe ony; (3-31) 
n-6 


where n 1s the number of experiment vectors used in the maximum likelihood 
estimation. The first term in equation (3-31) corrects for the bias caused by the 
constrained minimization problem [Bard 1974]. We can compare the results of 
equation (3-31) with the assumed covariance matrix of the measurement errors to 
judge if the assumed covariance matrix V,, is valid. 
3.7 Summary 

In this chapter we have extended the results of chapter II to include linear 
motion of the acoustic beacon. We found that the solution to the maximum likelihood 
estimator for the case of the moving beacon follows the same form as the solution for 
the case of the stationary beacon. The quantity (j - /) is one of the free parameters of 


the moving acoustic beacon estimation problem. We define this quantity as the 
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effective sensor spacing. This quantity corresponds to the spacing in time between the 
two signals used to form the experiment vector w,. The other free parameter is the 
number of experiment vectors to use in the parameter estimation problem. In the next 
chapter we examine the performance of the algorithm described in this chapter for 


different choices of the two free parameters. 


ah, 





Chapter IV 
Algorithm Simulations and Tests 
4.1 Introduction 

In chapters II and III we developed algorithms to solve for the maximum 
likelihood estimate of an acoustic beacon's position for both the stationary and the 
moving beacon. In both chapters we were left with choosing how many experiment 
vectors (w,) to use, and which measurement vectors (m,) to use to define the 
experiment vectors. We defined the effective element spacing to be the number of 
pulse repetition intervals (T,) between the measurement vectors that form the 
experiment vector w,. In this chapter we examine the performance of the algorithms 
developed in chapters II and III for different numbers of experiment vectors, and for 
different effective element spacings. We show that the accuracy of the estimated 
beacon position (6°) improves, while the variance of the estimated position decreases 
as the number of experiment vectors used to find the maximum likelihood estimate 
increases. We also show that the accuracy of the estimated beacon position improves, 
and the variance of the estimated position decreases with increased effective sensor 
spacing. This result is similar to the methods mentioned in chapter I. 

To test the algorithms of chapters II and III, Monte Carlo simulations were 
conducted for several different initial positions and velocities of the acoustic beacon. 
Results from six of the scenarios tested are presented in the following sections. We 
assume that the measurement errors are as defined in section 2.4. To see how the 


accuracy of the measured position of receipt (x,, y,,) affects the maximum likelihood 
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estimate, we use GPS errors of 3 meters rms and 25 meters rms. These errors 
approximate the errors of a Differential/P code GPS receiver and a C/A code GPS 
receiver respectively. For measurement errors in the synchronized time of receipt t,,,, 
we assume the sampling rate of the receiver, T,, is 1 millisecond and use equation (2- 
16) to define the variance. 
4.2 Synthetic Measurement Vector Generation 

To test the algorithms of chapters II and III, synthetic measurement vectors 
were generated for several different acoustic beacon positions and velocities. Table 
4-1 lists the initial position and velocities for each of the scenarios presented. We 
assume that the receiving ship moves in a hexagonal search path with legs of 1000 


meters. This is a reasonable search path in the general location of the acoustic 


beacon which ts easy to model. The actual path of the receiving ship is not critical, 


Xp Yz ZR Vy Vy Vv, 
(m) (m) (m) (m/s) (m/s) (m/s) 


| zoo | oo | eo fo 





Table 4-1 


as long as it is not linear. If the receiving ship's path is linear we will be unable to 


61 





i} 


accurately resolve the acoustic beacon's position in three dimensions. This is 
analogous to the inability of a conventional linear array to resolve the direction of 
arrival of a signal in two dimensions. We restrict the speed of the receiving ship to 
five meters per second so that flow noise does not become a problem. 

Figure 4-1 shows the positions of the acoustic beacon for the scenarios defined 


in Table 4-1] compared to the path of the receiving ship. 






seenarios 3 & 6 


O ; Sseenarios 2 & 5 







Receiving Ship's 
Course 
/ 


Starting Point —~ 


© Initial Beacon 
Location 


Figure 4-1 


Scenarios | and 4 corresponds to an acoustic beacon located in the center of the search 
path, scenarios 2 and 5 correspond to an acoustic beacon located directly below the 


search path, and scenarios 3 and 6 correspond to an acoustic beacon located outside of 
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the search path. 
To generate the synthetic measurement vectors m,, we solve for the intercept of 


the receiving ship and the beacon signal. Figure 4-2 shows the intercept geometry. 





beacom orginal 


Acoustic Beacon 


IFocation 
ee Ya, Z,) 
Figure 4-2 


The position x,, y; is the location of the receiving ship when the beacon signal 1s 
transmitted, and the position x,, y, is the location of the ship when the beacon signal 
is received. Using a homogeneous ocean model and a direct path propagation mode, 


we calculate the synchronized time of receipt by finding the positive root of: 


o -t? Pe B “ft +¥ = 0 (4-1) 


where: 


= 5*-C? 


& 
| 


TO 
il 


2 «s ‘[cos(cse)-(x;-x,) + sin(cse )-(y,-y,)] (4-2) 


: (Cy ay eye): + Zp 
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Here s is the speed of the receiving ship in meters per second, C is the speed of sound 
in sea water, and cse is the course of the receiving ship in degrees. It is assumed that 
the receiving ship does not change its course for the duration of the calculation. Once 
we have the synchronized time of receipt, we calculate the position of receipt x,, y, 


using: 


XK, = 4, tts -cos(cse) 
(4-3) 
y, = I+ tS “sin(cse) 


To find the next synchronized time of receipt and position of receipt (x,, y,) 


we update the acoustic beacon's position based on its velocity: 


Xp = X_+T)-v, 

Se 7 at ane (4-4) 
Zp = 23+ Iv, 
where T, is the pulse repetition interval of the acoustic beacon. For the results 
presented in the following sections we assume the acoustic beacon has a pulse 


repetition interval of 2 seconds. Next we find the location of the receiving ship when 


the new beacon signal is transmitted using: 


x: 


; = x; + T,’s -cos(cse) 


(4-5) 


y, = Y,+ Ts" sin(cse) 


We then solve for the intercept of the beacon signal and the receiving ship using 
equations (4-1) and (4-2). We continue in this manner until we have generated a 


sufficient number of measurement vectors m,. Once we have generated the 
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measurement vectors, we add normally distributed random error terms to each 
measurement based upon the errors discussed in section 2.4. 
4.3 Stationary Acoustic Beacon 

In this section we examine the performance of the algorithm given in Figure 
2-4. Figures 4-3 through 4-50 contain the results of the Monte Carlo simulations 
conducted for scenarios | through 3. For each scenario, the initial value of the 


estimated parameter vector 0° is taken as: 


65 =[0 0 -2500 ]’ (4-6) 


The feasible region is defined by Range,,,. = Depth,,,, = 5000 meters. If the maximum 


max max 


likelihood estimate found using the algorithm of chapter II is outside the feasible 
region, the corresponding entries are left blank. To find a solution for these cases, we 
need to start with a different initial parameter vector 6°, or use more experiment 
vectors. 

To test the effect of increasing the number of experiment vectors (7), we solve 
for the estimated parameter vector 0° using n ranging from 5 to 50. We fix the 
effective sensor spacing at 45 pulse repetition intervals by using every 45" received 
beacon signal in defining the experiment vectors. To test the effects of increasing the 
effective sensor spacing, we solve for the estimated position vector using effective 
sensor spacings ranging from 2 to 90 pulse repetition intervals. For this case we fix 
the number of experiment vectors used to 25. We conduct each experiment using GPS 
errors of 3 meters rms and 25 meters rms. The results of the estimation algorithm for 


GPS errors of 3 meters rms are shown by x's on the plots, while the results of the 
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estimation algorithm for GPS errors of 25 meters rms are shown by 0's. 
4.3.1 Scenario 1 - Stationary Acoustic Beacon Located at 6 = [0 0 -2000]' 

Figures 4-3 through 4-10 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-11 
through 4-18 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 1. We see that in general, as the 
number of experiment vectors used in the maximum likelihood estimation problem 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. Also, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. For both cases, the position errors and 
the standard deviation of the estimates initially decrease rapidly as the receiving ship 
spans more of its two dimensional search path. However after the number of 
experiment vectors used reaches approximately 20, or after the effective sensor spacing 
reaches approximately 35, the errors and the standard deviations decrease at much 
slower rate. At this point the receiving ship has completed two legs of the search 
path, and spans enough of the two dimensional search path to form a decent estimate 


of the acoustic beacon's position. 
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4.3.2 Scenario 2 - Stationary Acoustic Beacon Located at 6 = [0 866 -2000]' 

Figures 4-19 through 4-26 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-27 
through 4-34 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 2. Like scenario 1, as the number of 
experiment vectors used in the maximum likelihood estimation problem increases, the 
accuracy of the estimated beacon position improves, and the standard deviation of the 
estimated position decreases. Also like scenario 1, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. Again we see an initial rapid decrease 
in the errors and standard deviations which levels off after the number of experiment 
vectors used reaches approximately 20, or the effective sensor spacing reaches 
approximately 35. As in scenario 1, these values correspond to when the receiving 
ship completes the second leg of the search path. 

Unlike scenario 1, we see a significant improvement in the estimated position 
(especially when using 25 meter GPS errors) when the number of experiment vectors 
used is greater then 40, or the effective sensor spacing is greater then 65. At this 
point the receiving ship passes directly over the acoustic beacon and begins moving 
away from the beacon on the fourth leg of the search path. To see why we get this 
improvement, we can define a vertical plane as the plane orthogonal to the x-y plane 
that passes through the acoustic beacon's position and the starting point of the leg of 


the search path that the receiving ship is currently on. In general, it was found that if 
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the receiving ship moves such that it stays in this vertical plane, significant 
improvements to the estimated beacon location can be made. This is because as the 
receiving ship moves in the same vertical plane relative to the acoustic beacon, the 
localization problem is essentially a two dimensional problem, and the range 
differences between measurement vectors is maximized for a given ship's velocity. 
The same is true if the acoustic beacon and the receiving ship are in the same 


horizontal plane. 
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4.3.3 Scenario 3 - Stationary Acoustic Beacon Located at 6 = [-1000 1000 -2000]" 

Figures 4-35 through 4-42 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-43 
through 4-50 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacing for scenario 3. Like the first two scenarios, as the 
number of experiment vectors used in the maximum likelihood estimation problem 
increases, the accuracy of the estimated beacon position improves, while the standard 
deviation of the estimated position decreases. Also, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, while the standard 
deviation of the estimated position decreases. Again we see an initial rapid decrease 
in the errors and standard deviations which levels off after the number of experiment 
vectors used reaches approximately 20, and the effective sensor spacing reaches 
approximately 35. As in the first two scenarios, these values correspond to when the 
receiving ship completes the second leg of the search path. 

In this scenario, we see a significant improvement in the location estimate 
when the number of experiment vectors used is greater then 45, or when the effective 
element spacing is greater then 75. At this point the receiving ship passes through the 
closest point of approach to the acoustic beacon on the fifth leg of the search path. In 
general, it was found that the estimate of the acoustic beacon's location improves as 
the receiving ship passes through closest points of approach to the acoustic beacon 


along the search path. 
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4.3.4 Stationary Acoustic Beacon Summary 

From scenarios | through 3 we showed that as the number of experiment 
vectors used in the maximum likelihood estimation problem increases, the accuracy of 
the estimated beacon position improves, while the standard deviation of the estimated 
position decreases. Also, as the effective sensor spacing increases, the accuracy of the 
estimated beacon position improves, while the standard deviation of the estimated 
position decreases. We also showed that as the receiving ship passes through a closest 
point of approach, the estimated position of the acoustic beacon improves. This is 
why the estimate of acoustic beacon's location in scenario | is better then the estimates 
obtained for the other two scenarios. In scenario 1, each leg of the search path passes 
through a closest point of approach. This is not true for the other two scenarios. In 
all of the scenarios, we see that the depth of the acoustic beacon is the least accurately 
estimated parameter. This is because we are attempting to locate the acoustic beacon 
in three dimensions, while the receiving ship only moves in two dimensions. Finally, 
we see that the accuracy of the estimated acoustic beacon position obtained from using 
GPS errors of 3 meters is approximately an order of magnitude better then the 
estimated acoustic beacon position obtained from using GPS errors of 25 meters. 

These observations suggest that to obtain the best possible estimate of the 
acoustic beacon's location, we need to use a large number of experiment vectors with a 
large effective sensor separation, and we need to use a Differential/P code GPS 
receiver. The problem with this is that the time it takes to collect the measurement 


vectors used to form the experiment vectors increases with increasing sensor spacing 
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and increasing numbers of experiment vectors. As an example, with an effective 
sensor spacing of 45 pulse repetition intervals, a pulse repetition interval of 2 seconds, 
and using 50 experiment vectors it takes over 76 minutes to collect the required 
measurement vectors. If time is an issue, then we must use fewer experiment vectors 
and shorter effective sensor spacings. From looking at the results of the simulations 
presented above, for the hexagonal search path of figure 4-1 and for a pulse repetition 
interval of 2 seconds, the minimum required number of experiment vectors is 20, and 
the minimum effective sensor spacing is 35. With these values we span enough of the 
two dimensional search path to obtain a decent estimate of the acoustic beacon's 
location. 
4.4 Moving Acoustic Beacon 

In this section we examine the performance of the algorithm given in Figure 
3-1. Figures 4-51 through 4-146 contain the results of the Monte Carlo simulations 
conducted for scenarios 4 through 6. For each scenario, the initial value of the 


estimated parameter vector 9° is taken as: 


6,=[0 0 -2500 0 0 0]’ (4-7) 
The feasible region is defined by Range,,,, = Depth,,,, = 5000 meters, and v,,,.. = 
Vymax = Vamax = > Meters per second. If the maximum likelihood estimate found using 


the algorithm of chapter III is outside the feasible region, the corresponding entries are 
left blank. To find a solution for these cases, we need to start with a different initial 
parameter vector 8, or use more experiment vectors. 


To test the effect of increasing the number of experiment vectors (”), we solve 
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for the estimated parameter vector 8 using ” ranging from 10 to 50. We fix the 
effective sensor spacing at 60 pulse repetition intervals by using every 60" received 
beacon signal in defining the experiment vectors. To test the effect of increasing the 
effective sensor spacing, we solve for the estimated position vector using effective 
sensor spacings ranging from 2 to 90 pulse repetition intervals. For this case we fix 
the number of experiment vectors used to 30. We conduct each experiment using GPS 
errors of 3 meters rms and 25 meters rms. The results of the estimation algorithm for 
GPS errors of 3 meters rms are shown by x's on the plots, while the results of the 
estimation algorithm for GPS errors of 25 meters rms is shown by o's. 

4.4.1 Scenario 4 - Moving Acoustic Beacon Located at: 

8 = [0 0 -2000 0.5 -0.5 0.25]' 

Figures 4-51 through 4-66 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-67 
through 4-82 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 4. Similar to the stationary acoustic 
beacon scenarios, we see that as the number of experiment vectors used in the 
maximum likelihood estimation problem increases, the accuracy of the estimated 
position and velocities of the acoustic beacon improves, while the standard deviation 
of the estimated position and velocities decrease. We also see that as the effective 
sensor spacing increases, the accuracy of the estimated position and velocities of the 
acoustic beacon improves, and the standard deviation of the estimated position 


decreases. As with the stationary acoustic beacon, the position and velocity errors 
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initially decrease rapidly, however, after the number of experiment vectors used 
reaches approximately 30, or the effective sensor spacing reaches approximately 45, 
the errors and the standard deviations decrease much slower. 

Figures 4-61 through 4-66 and figures 4-77 through 4-82 show the estimation 
algorithm's ability to track the linearly moving acoustic beacon. We see that projected 
current positions follow the linearly moving acoustic beacon fairly well when using 3 
meter GPS errors. We also see that the standard deviation of the projected current 
positions decrease as the number of experiment vectors used increases and the 
effective sensor spacing increases. However, we notice in a few cases the standard 
deviations increase slightly for increasing numbers of experiment vectors used and 
increasing effective sensor spacing. This is a result of projecting the current position 


forward in time using equation 3-19. 
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4.4.2 Scenano 5 - Moving Acoustic Beacon Located at: 

© = [0 866 -2000 0.5 -0.5 0.25]" 

Figures 4-83 through 4-98 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-99 
through 4-114 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 5. Similar to the previous scenarios, 
we See that as the number of experiment vectors used in the maximum likelihood 
estimation problem increases, the accuracy of the estimated position and velocities of 
the acoustic beacon improves, while the standard deviation of the estimated position 
and velocities decrease. We also see that as the effective sensor spacing increases, the 
accuracy of the estimated position and velocities of the acoustic beacon improves, and 
the standard deviation of the estimated position decreases. As before, the position and 
velocity errors initially decrease rapidly, however after the number of experiment 
vectors used reaches approximately 30, and the effective sensor spacing reaches 
approximately 45, the errors and the standard deviations decrease much slower. 

Figures 4-93 through 4-98 and figures 4-109 through 4-114 show the estimation 
algorithm's ability to track the linearly moving acoustic beacon for this scenario. We 
see that the projected current positions follow the linearly moving acoustic beacon 
fairly well for both 3 meter and 25 meter GPS errors. This is because the estimated 
initial positions x,, y,, and z, obtained using 25 meter GPS errors were better in this 
scenario then for scenario 4. In general this is not the case, however the measurement 


errors in this scenario simply led to a better estimate of the acoustic beacon's position. 
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4.4.3 Scenano 6 - Moving Acoustic Beacon Located at: 

8 = [-10000 1000 -2000 0.5 -0.5 0.25]* 

Figures 4-115 through 4-130 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-131 
through 4-146 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 6. Again we see that as the number of 
experiment vectors used in the maximum likelihood estimation problem increases, the 
accuracy of the estimated position and velocities of the acoustic beacon improves, and 
the standard deviation of the estimated position and velocities decrease. We also see 
that as the effective sensor spacing increases, the accuracy of the estimated position 
and velocities of the acoustic beacon improves, while the standard deviation of the 
estimated position decreases. As before, the position and velocity errors initially 
decrease rapidly, however after the number of experiment vectors used reaches 
approximately 30, or the effective sensor spacing reaches approximately 45, the errors 
and the standard deviations decrease much slower. 

Figures 4-125 through 4-130 and figures 4-141 through 4-146 show the 
estimation algorithm's ability to track the linearly moving acoustic beacon for this 
scenario. We see that the projected current positions follow the linearly moving 
acoustic beacon fairly well using 3 meter GPS errors. Again, because of the errors in 
estimating the acoustic beacon's initial positions x,, y,, and z,, the projected current 
position obtained from using 25 meter GPS errors does not track the acoustic beacon's 


motion as well. 
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4.4.4 Moving Acoustic Beacon Summary 

From scenarios 4 through 6 we showed that as the number of experiment 
vectors used in the maximum likelihood estimation problem increases, the accuracy of 
the estimated position and velocities of the acoustic beacon improves, while the 
standard deviation of the estimated position decreases. Also, as the effective sensor 
Spacing increases, the accuracy of the estimated position and velocities of the acoustic 
beacon improves, and the standard deviation of the estimated position decreases. For 
all of the moving acoustic beacon scenarios, we see that the depth of the acoustic 
beacon 1s the least accurately estimated parameter. This is because we are still 
attempting to locate the acoustic beacon in three dimensions, while the receiving ship 
only moves in two dimensions. We also note that the standard deviations of the 
estimated beacon position are significantly larger for the moving beacon scenarios then 
for the stationary beacon scenarios. These larger standard deviations are due to the 
nature of the structural model and reflect the difficulties in locating a moving acoustic 
beacon using only a single omnidirectional hydrophone as a receiving source. 

Similar to the stationary acoustic beacon scenarios, to obtain the best possible 
estimate of the acoustic beacon's location we need to use a large number of experiment 
vectors with a large effective sensor spacing. Again we run into problems with the 
time it takes to collect the required measurement vectors. For example, with an 
effective sensor spacing of 60 pulse repetition intervals, a pulse repetition interval of 2 
seconds, and using 50 experiment vectors it takes 100 minutes to collect the required 


measurement vectors. As with the stationary acoustic beacon scenarios, if time is an 
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issue, we must reduce the number of experiment vectors used, and reduce the 
effective sensor spacing. As a minimum, we must use at least 30 experiment vectors 
and a minimum effective sensor spacing of 45 pulse repetition intervals. With these 
values, for the search path of figure 4-1 and for a pulse repetition interval of 2 
seconds, we should be able to obtain a decent estimate of the acoustic beacon's 
position and velocities. 
4.5 Summary 

From the results of the Monte Carlo simulations we see that in general, as the 
number of experiment vectors used to find the estimated parameter vector @ increases, 
the errors of the estimated parameters and the variance of the estimated parameter 
vector deceases. This implied that to obtain the best estimate of the acoustic beacon's 
location, we should use a large number of experiment vectors, with a large effective 
Sensor spacing. We run into problems with this is approach if the time it takes to 
obtain an estimated position is a factor. We showed that for the search path given in 
section 4.2 and for an acoustic beacon with a pulse repetition interval of 2 seconds, we 
need to use a minimum of 20 experiment vectors and an effective sensor spacing of 35 
pulse repetition intervals to obtain a decent estimate when using the stationary acoustic 
beacon algorithm. We also showed that with the same search path and pulse repetition 
interval, we need to use a minimum of 30 experiment vectors and an effective sensor 
spacing of 45 pulse repetition intervals. In all scenarios, the use of accurate 
navigational equipment to measure the position of the receiving ship is critical to 


obtain an accurate estimate of the acoustic beacon's location. This is shown by the 
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better estimates obtained from using Differential/P code GPS errors of 3 meters rms. 
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Chapter V 
Receiver Design 

5.1 Introduction 

A receiver must be designed to implement the maximum likelihood estimation 
algorithms described in chapters II and III. This receiver should fulfill the goals of 
being an inexpensive, lightweight, easily transported receiver that can perform all of 
the functions of an older chart recorder. To determine the specifications for the 
receiver hardware, we look at the signal that is received, the ambient noise that is 
received, the thermal noise generated by the receiver's preamplifier, and the required 
signal output. We also examine the characteristics of the hydrophone used as a 
receiving sensor, and develop a practical hydrophone model so the preamplifier's input 
characteristics can be determined. 

In designing a receiver to implement the algorithms described in chapters II 
and JII, we make the following general assumptions. We assume that the beacon 
signal has a carrier frequency of 10,000 Hertz, a pulse width of 10 milliseconds, and a 
pulse repetition interval of 2 seconds. This is similar to several acoustic beacons 
currently in use. To cut costs, a Motorola 68HC11 microcontroller will be used. The 
68HC11 is an 8-bit, low power microcontroller with several useful peripheral 
functions built in. These peripheral functions include an eight channel 8-bit analog to 
digital (A/D) converter, an asynchronous serial communications interface, five general 
input/output ports, and a 16-bit free running timer system with five output compare 


registers. This lets us use a single chip to synchronize the time of receipt t, to the 
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pulse repetition interval, digitally sample the received signal, control the receiver's 
gain, and communicate with the interfacing computer. Another factor in deciding to 
use the 68HC11 microcontroller is that the 68HC11 and it's programming support 
equipment are commonly available. For the receiving sensor, we use the Benthos 
AQ-4 hydrophone attached to 100 meters of RG-58/u coaxial cable. The Benthos 
AQ-4 hydrophone has an open circuit response of -201 dB re 1 Volt per lpPa, which 
is representative of the type of omnidirectional hydrophones currently available. 
5.2 Design Criterion 

The signal transmitted by the acoustic beacon can be characterized as a 
sequence of gated continuous wave pulses at a carrier frequency f,. We depict the 


beacon signal as: 


s,(t) = 3 w(t-iT,-T,) -cos[2 x f,(t-iT, -T,)+9] (5-1) 
i=0 


where w(t) is a windowing function that defines the pulse width, T, is the period 
which defines the pulse repetition interval, and d is a phase term. As before, the 
coefficient T, represents the unknown absolute time reference. 


We can represent the signal that is received by the observer as: 
R(t) = Yo he w(t-iT,- tey)-00s|2 ef, (E-iT,- 4+ G] +e) OD) 
i=0 


where h, represents the attenuation the signal experiences in traveling from the beacon 


to the observer, and G, represents a random phase distortion due the propagation of 
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the signal through the ocean. As discussed in chapter II, the term t,, represents the 


synchronized time of receipt and is given by: 
ect on pe 7 (5-3) 


where Ty, 1s the acoustic travel time of the beacon signal. The term n(t) represents 
the combination of the ambient noise that is received and the thermal noise that is 
generated by the receiver's preamplifier. 

Since we use range differences in the maximum likelihood estimation 
algorithms of chapters II and III, the parameter that we need to find from the received 


signal is the synchronized time of receipt t,,. In order to find t,,, we digitally process 


sy 
the received signal. To determine the proper sampling rate, we must look at the 
frequency content of the received signal and the desired accuracy of the synchronized 
time of receipt t,,. If we apply the Nyquist sampling rate theorem directly to the 
received signal, the sampling rate would have to be greater then twice the carrier 
frequency f.. For carrier frequencies around 10,000 Hertz, the required sampling rate 
is too fast for the 68HC11 to handle both the data collection and the signal processing. 
However, from looking at equation (5-2), we notice that the received windowing 
function w(t) contains the parameter t,,. Therefore, if we remove the carrier frequency 
and just look at the envelope of the received signal given by w(t), we can still 
determine the synchronized time of receipt by observing when the signal's envelope is 
received. To remove the carrier frequency f,, we use a precision rectifying circuit 


with a low pass filter to form an envelope detector. This allows us sample at the 


reduced rate of twice the bandwidth of the signal's envelope given by w(t). 
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To reduce the receiver's overall noise level, the bandwidth of the receiver 
should match the bandwidth of the envelope. If the bandwidth of the receiver 
increases above the bandwidth of the received signal's envelope, out of band noise 
from the oceanic environment and other interference sources enters the receiver, 
decreasing the signal to noise ratio. On the other hand, if the receiver's bandwidth is 
less then the bandwidth of the received signal's envelope, we do not allow the full 
bandwidth of the envelope to pass through the receiver, which again lowers the signal 
to noise ratio. The windowing function w(t) can be approximated by a simple 
rectangular window with a duration equal to the pulse width of the signal. The 
bandwidth of the windowing function and the receiver is then given by: 

Bandwidth = ——'__— (5-4) 
PulseWidth 
For a pulse width of 10 milliseconds, the windowing function's bandwidth is 100 
Hertz. With a bandwidth of 100 Hertz, the sampling frequency must then be at least 
200 Hertz, which equates to a sampling interval of no more then 5 milliseconds. 

We must be careful not to sample at too slow a rate, otherwise the errors 
associated with the quantization of the time base will cause large errors in the 
localization algorithms. To determine an acceptable quantization step size, or 
equivalently, how much error can we tolerate in the time of receipt data, we need to 
compare the quantization errors to the errors in measuring the observer's location. The 
source of error in measuring the observers position is due to errors in the GPS position 


data. For a C/A-code GPS receiver, the published rms errors are on the order of 25 
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meters. Using a simple homogeneous, direct path propagation model with the speed of 
sound in water equal to 1500 meters per second, a signal takes 16.667 milliseconds to 
travel 25 meters. We call this the equivalent time error of the position error. We 
would like the errors associated with the quantization of the time base to be less than 
the equivalent time error of the position errors. Assuming no other errors in the time 
of receipt, the maximum error in measuring the time of arrival t,, is half the sampling 
interval. For a C/A code GPS receiver the required sampling interval of 5 
milliseconds is much less then the equivalent time error of the position error, therefore 
the quantization errors are relatively small compared to the errors in measuring the 
Observer's position. However, because more accurate navigational equipment will 
most likely be available in the near future, and because the 68HC11 has the required 
speed, we will sample the received signal's envelope every | millisecond. With a 
sampling interval of 1 millisecond, as long as the rms errors of the navigational system 
are greater than 1.5 meters, the quantization errors will be smaller then the equivalent 
time errors of the position errors. 

To determine the synchronized time of receipt t,, from the sampled envelope, 
we pass the sampled envelope through a matched filter based upon w(t), and look for 
the time that corresponds to the maximum value of the output of the matched filter. 
The received time is then divided modulo the pulse repetition interval to obtain the 
synchronized time of receipt. The use of a matched filter has two benefits. First, the 
output of a matched filter for a rectangular input signal with the same pulse width of 


w(t) will have a unique maximum peak which we can use to calculate the time of 
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receipt. Secondly, a matched filter produces an output with the maximum signal to 
noise ratio. The digital form of a matched filter for a rectangular signal has the form 


of the moving average: 


N 


1 
y[n] Nel & x[n-t] 


For a pulse width of 10 milliseconds and a sampling rate of 1 millisecond, N is equal 
to 10. Figures 5-1 and 5-2 show the output of the moving average matched filter for 
an input that represents the sampled envelope of the received signal with additive 
noise. From figure 5-2 we see that it is relatively easy to find the maximum value of 
the output of the matched filter. We do not have to worry about the phase delay of 
the matched filter because we compare the time of arrival of two signals relative to 
each other. Since the phase delay is the same for all received signals, it does not 


effect the comparison of the two arrival times. 





© Sampled Envelope with Additive Noise 


Figure 5-1 
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Figure 5-2 


The receiver should be able to detect the target's beacon signal in the presence 
of the additive noise term n(t). The two largest contributors of noise are ambient 
Oceanic noise and thermal noise generated by the receiver's preamplifier. Ambient 
Oceanic noise, due to factors such as wind force, ships, industrial activity, 
precipitation, biologics, and others, is received by the hydrophone which generates an 
equivalent noise voltage. Using the hydrophone's open circuit response 
characteristics, the receiver's bandwidth, and empirical data of noise spectrum levels 
summarized by Wenz [Wenz 1962], the equivalent noise voltage of the oceanic noise 


can be calculated using: 





Hi+e 
2<~*¢ + og(BW)} (5-6) 
e. = id = 


where H,, is the hydrophones open circuit response in dB re 1 Volt per luPa, e, is the 
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ambient oceanic noise in dB re |uPa, and BW is the receiver's bandwidth in Hertz. 
Table 5-1 shows the equivalent noise voltage for various Sea states (Beaufort Scale) at 
10,000 Hertz using a hydrophone with an open circuit receiver response of -201 dB re 
1 Volt per luPa, and a receiver bandwidth of 100 Hertz. Ideally the noise in a 
receiver should be dominated by exterrial noise sources. This means that the receiver's 
thermal noise should be less then the ambient oceanic noise. Since sea states 1 and 2 
are not common, the receiver's thermal noise is designed to be less then the ambient 
oceanic noise associated with sea state 3. This requirement limits the test receiver's 


thermal noise reflected at the input of the preamplifier to be less then 89 nV/VHz. 


Sea State Ambient Oceanic Equivalent Total Equivalent 
(Beaufort Scale) Noise Noise Valtage Noise Voltage e, 
(dB re IpPa) (nV/V¥ Hz) 





Table 5-1 
Another desirable characteristic of the receiver is that it should have as large a 
dynamic resolution as possible. A large dynamic resolution allows the receiver to 
detect a broad level of signal amplitudes for a set gain. Since the received signal will 


be digitally processed, we need to look at the dynamic resolution of the A/D converter. 
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The dynamic resolution of an A/D converter is given by: 


Dynamic Resolution = 20 log,,(2"*) (5-7) 


For and 8 bit A/D converter, the dynamic resolution is only 


20 log,.(2°) = 48 dB (5-8) 


This is not quite large enough. We would like a dynamic resolution that is 
comparable to the dynamic resolution of the older paper recorders. This means we 
need a dynamic resolution of at least 60 dB. To increase the dynamic resolution, 
either a higher bit A/D converter could be used, or a logarithmic compressor can be 
used prior to digital sampling. Since we are restricted to the 8 bit A/D converter of 
the 68HC11, a logarithmic compressor will be used to increase the receiver's dynamic 
resolution. 
Using a logarithmic compressor, the dynamic resolution is given by: 
, Ve 
Dynamic Resolution = 20 ote 7 | (5-9) 
min 
where V,,, is the saturation point of the logarithmic compressor and V,,., is the 
minimum detectable signal at the input of the logarithmic compressor. Typically, 
logarithmic compressors require an input signal that is greater then 2 mV. Below 2 
mV, the input current to the logarithmic compressor becomes comparable to the bias 


current of the matched transistors used to obtain the logarithmic dependence, and 
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subsequently the logarithmic dependence is no longer valid [Millman 1979]. For the 
receiver designed in section 5.4, V,,, is approximately 8 V which gives a dynamic 


resolution of: 





Dynamic Resolution = 20 089 | = 72 dB (5-10) 
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To determine the required gain of the receiver, we need to look at the signal 
level that we are attempting to receive. We wish to be able to detect low level signals 
that are right at the noise floor of the receiver. This requires the receiver to have 
enough gain to detect a signal at the equivalent oceanic noise level of 89 nviv Hz. 
Since a logarithmic compressor is used just prior to A/D conversion, the required gain 
is determined by the minimum detectable level in the logarithmic compressor and the 
Oceanic noise level. Using the ambient oceanic noise and the input requirements of 
the logarithmic compressor from above, the maximum required gain of the receiver 1S 
given by: 


BNE 
"mx 89 - 10-9 


7 dB (5-11) 
However, it is possible that the received signal could be quite a bit larger then 
the minimum signal level for a strong beacon in close proximity to the receiving ship. 
For example, a 30 Watt beacon 100 meters from the receiving hydrophone will 
produce an input signal of about 10 mV. This signal would completely saturate the 


receiver if the gain is fixed at Ay... To prevent the receiver from saturating, some 


form of feedback gain control is needed. Using one of the output ports of the 68HC11 
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as a control line, simple resistive attenuators can be switched on or off to reduce or 
increase the gain of the receiver based upon the maximum signal level at the A/D 
converter. To determine how much attenuation is needed, we look at the saturation 
point of the preamplifier and the maximum likely input signal. For design purposes, 
to keep a 10 mV signal from saturating the receiver, the receiver's minimum gain is 
given by: 

A, = =—*__-584B (5-12) 

10°10 10-10 

Here again V,,, is the logarithmic compressor's saturation level. Since the input 
signal level will be somewhere between the noise floor and the maximum likely input 
signal most of the time, we can use multiple resistive attenuator networks to set the 
and A 


receiver's gain to any level in between A For this design we will use 


Vmax Vmin° 
four resistive attenuator networks to provide attenuation levels of -3 dB, -9 dB, 
-12 dB, -18 dB, -24 dB, and -30 dB. 
5.3 Hydrophone Model 

To determine the input characteristics of the preamplifier, the hydrophone and 
cable must be modeled. Figure 5-3 shows an equivalent circuit for a stiffness- 
controlled piezoelectric hydrophone. Here R, is the hydrophone's resistance, C,, is the 
hydrophone's capacitance, e, represents the equivalent ambient noise of the ocean, and 


é,, represents the thermal noise of the hydrophone. For frequencies considerably 


below 100 kHz, the ambient noise level of the ocean is much greater then the 
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hydrophone's thermal noise, while the impedance of the hydrophone is dominated by 
the capacitance C,. This allows us to simplify the hydrophone model by eliminating 


R,, and e,, [Wilson 1985]. 


| L 


Figure 5-3 


The cable assembly can be modeled as a two conductor transmission line. 
Using standard RG-58/u coaxial cable with a solid copper inner conductor and a 
polyethylene dielectric, we can model the cable as a series resistance R, and a shunt 
capacitance C, [Cheng 1983]. Standard RG-58/u coaxial cable has a series resistance 
of 33.31 2 per 1,000 meters, and shunt capacitance of 70 pF per meter. Combing the 


simplified hydrophone model and the cable model, we have the circuit of figure 5- 4. 


2400 pF “03, {) 





z eS 6000 pF 
Figure 5-4 
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Figure 5-4 can be simplified to give the equivalent Thevinin circuit model: 





Figure 5-5 


The source impedance Z,( f ) is given by: 


2jn7fR,C, +1 


=) ee eee Ae (5-13) 
[27 TFRO,C, +(C, + C,) [27 af 


ZAf ) 
Figure 5-6 shows a plot of the source impedance verses frequency for the Benthos 
AQ-4 hydrophone with C, specified as 2,400 pF +25%. To prevent serious loading 
effects, the preamplifier's input impedance must be considerably larger then the source 
impedance given by equation (5-13). For design purposes, the magnitude of the 
source impedance at 10,000 Hertz is 1,693 Q, therefore we choose the preamplifier's 
input impedance to be at a minimum of 20 time the source impedance, or 33.8 kQ. 


This will keep the loss due to loading below 0.5 dB. 
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Figure 5-6 


5.4 Test Receiver Hardware Design 

Based on these design criteria, a receiver was built for testing. This section 
discuses the circuit design considerations and implementation of this test receiver. 
Figure 7 shows the general signal flow of the receiver starting with the preamplifier 
and moving to the 68HC11 microcontroller. An important theme of the receiver 
design 1s to avoid exotic components to minimize the cost of the receiver. 
5.4.1 Preamplifier 

Refer to the preamplifier schematic diagrams in Appendix 1 for the following 
description. The first stage of the preamplifier is a tuned N channel junction field 
effect transistor (JFET) common-source amplifier. To help keep low frequency 


ambient oceanic noise from entering the preamplifier, C,, and R,, form a high pass 
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filter with a cutoff frequency given by: 


1 


Bees. (5-14) 
27 Ry Coy 


f, 


To eliminate as much low frequency oceanic noise as possible but still allow for small 
changes in the acoustic beacon's carrier frequency, we chose the high pass filter cut off 
frequency as 7000 Hertz. The preamplifier's input impedance is determined by R,, 
since the input impedance of the JFET is so large (>10'* Q). To prevent loading 
between the hydrophone source and the preamplifier we must ensure Rj, 1s larger then 
33.8 kQ. To ensure that the thermal noise of the preamplifier is less then equivalent 
Oceanic noise of sea state 3, R,, must be chosen such that the thermal noise of the 


parallel combination of R,, and source impedance Z,( f ) is considerably less then 
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89 nVVHz. The thermal noise of a resistor is given by: 


@.= /4kiRB (5-15) 
where k is Boltzmann's constant, t 1s the absolute temperature in Kelvin, B is the 
bandwidth in Hertz, and R is the resistance in Ohms [Horowitz and Hill 1989]. For 
the Benthos AQ-4 hydrophone at a frequency of 10,000 Hertz Z.( f ) is approximately 
1700 2. As a result, the parallel combination of R,, and Z,( f ) will be close to the 
value of Z.( f) for R,, greater then 32 kQ, and the associated thermal noise will be 
well below 89 nV/VHz. However, it would be nice to ensure that the thermal noise of 
the preamplifier is much less then equivalent oceanic noise of sea state 3 for any 
source impedance. To ensure this, we choose R,, such that its thermal noise is 
approximately 45 nviv Hz. To meet the noise constraint, the loading constraint, and 
the cut off frequency constrain of equation (14), we choose R,, as 120 kQ and C,, as 
180 pF. 

The gain of the first stage JEET common-source amplifier is given by: 


wie 20S) Ta (5-16) 


ml) = Zo i+8, 


where Y,, is the JFET's forward transconductance, r, is the JFET's intrinsic drain 


resistance, and Z,( f ) is given by: 





2jnf 

% 
Z,(f) = —— + —_—_ (5-17) 
“am (inf + SUL. 

Came TCS 
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Zp( f ) represents the complex impedance of the combination of L,,, R,,, and C,,. The 
use of the reactive load Z,( f ) allows us to obtain the narrow bandwidth required by 
equation (5-4). The gain of the first stage will be greatest when the frequency of the 
input signal is at the resonant frequency of Z,( f ). The resonant frequency of Z,(/) 


is given by: 


ret. 
’ 2 cen 


We want the preamplifier to have it's maximum gain at the acoustic beacon's carrier 


(5-18) 


frequency, therefore we choose L,, and C,, such that the resonant frequency equals the 
acoustic beacon's carrier frequency . In the test receiver, Q,, 1s an E230 general 
purpose N channel JFET. The E230 has a nominal forward transconductance of 
1.5-10° Siemens and a nominal intrinsic drain resistance of 12.5 kQ. Using equations 
(5-16) and (5-17), and the values from Appendix 1, at a beacon frequency of 10,000 
Hz, Ay, is approximately 24 dB. 

In general, the output impedance of an R-L-C tuned amplifier is quite high, 
therefore, a JFET source follower is used as a buffer immediately following the first 
stage. Resistor R,, and capacitor C,, form a high pass filter similar to Ry, and C,,, 
and serve to capacitively couple the JFET source follower to the tuned JFET amplifier. 
The cut off frequency of the high pass filter formed by R,, and C,, is given by 
equation (5-14) with R,, substituted for R,, and C,, substituted for C,,. To prevent 
loading between the JFET amplifier and the JFET buffer, R,, must be significantly 


larger then the output impedance of the JFET amplifier. However, we must be careful 
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in choosing R,, so that its thermal noise, when reflected back to the input of the first 
stage, 1s less then 89 aviv Hz. Using equation (15), this limits R,, to 560 kQ. 

To enhance the performance of the JFET source follower, Q,, and R,, are 
added as a bootstrapped load. Because the base-emitter voltage of Q,, 1s 
approximately constant, the combination of R,, and Q,, cause a constant source current 
to flow through JFET Q,,. This makes Q,,'s Vc, approximately constant, which in 
return reduces nonlinearities [Horowitz and Hill 1989]. This is beneficial because the 
signal level at this point in the preamplifier is still quite small. 

The first stage of the preamplifier is powered by a separate 5 Volt 3-terminal 
7805 voltage regulator. We do this to isolate the first stage from subsequent stages, 
which prevents the feedback of any noise generated by subsequent stages along the 
main power supply line. This provides Q,, with a clean, stable supply voltage which 
is critical when working with very low level input signals. 

The second stage of the preamplifier is another tuned amplifier, this time using 
a PNP bipolar transistor. Capacitor C,, combined with the parallel combination of the 
bias resistors R,, and R,g form another high pass filter while also serving to 
capacitively couple the JFET source follower from the first stage to the second stage. 


The cutoff frequency of the high pass filter formed by C,,, Rp, and Ros 1s given by: 


Roy Re (5-19) 
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For this stage, we set the high pass filter's cut off frequency at 3000 Hertz. The gain 


of the second stage is given by: 





7, a (5-20) 
; Rio 
where 
2juf 
Cc 
ZAf) = - (5-21) 
2 2juf 1 
(2jnfy + 
117 ga oy 
As in the first stage we set the resonant frequency of Z.( f ) given by: 
(5-22) 


~ ZN V Loo Con 
to the acoustic beacon's carrier frequency. Using equations (5-20) and (5-21) fora 
beacon frequency of 10,000 Hertz, A, is approximately 31 db. 

Following the PNP tuned amplifier, a simple JFET source follower is used as a 
buffer. Capacitor C,, and resistor R,, form yet another high pass filter while also 
capacitively coupling the output of the PNP amplifier to the input to the JFET 
follower. The cut off frequency of the high pass filter formed by C,, and R,, 1s given 
by equation (14) with C,, substituted for C,, and R,, substituted for Ro,,and is set to 
3,000 Hertz. 

Similar to the first stage, the second gain stage is powered by a separate 5 
Volt, 3-terminal 7805 voltage regulator. Again we do this to prevent noise from being 


feedback along the power supply lines. 
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At the end of the second stage of the preamplifier the maximum gain at the 
acoustic beacon's carrier frequency is approximately 55 dB. We are under the 
minimum required gain of 58 dB, therefore we should not have to worry about the 
first two stages of the preamplifier saturating the logarithmic compressor. However, 
we still need an additional 32 dB of gain to reach the required maximum gain of 87 
dB. Prior to the next gain stage, we include an attenuation network to prevent 
subsequent stages from saturating. 

Following the JFET source follower Q,,, R,, in combination with shunt 
resistors R,., Rys, R,7, and R,, form a variable attenuation network which is controlled 
by the 68HC11 microcontroller. To reduce the gain of the preamplifier, any 
combination of R,, through R,, can be switched to ground through two CD4053 
analog switches. Once grounded, the shunt resistors form a voltage divider with R,,, 
and subsequently attenuate the signal. Following the shunt resistors is a simple 
common emitter amplifier that provides the final gain necessary to obtain a maximum 
of 87 dB. The gain of this stage, including the effects of the attenuator network Is 
given by: 


R 
206 RCo gale “0 
Bee yee (593) 


R R 
aera ite + 19% 
Rig t Roo Rig + Ryo 


where R, is the parallel combination of any shunt resistors R,, through R,, that are 


20 f Cyt Rot Ry 








switched to ground. If none of the shunt resistors are switched to ground, R, Is very 


large and A, approaches: 
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Ay, = ~ (5-24) 
2 


In this case the gain of the preamplifier is at its maximum of approximately 89 dB. In 





actuality, the maximum gain will be slightly less then 89 dB due to small losses 
caused by loading between the different stages. If all of the shunt resistors are 
switched to ground, R, is at its minimum value and the gain of the preamplifier is 
approximately 56 dB. Table 5-2 summarizes which shunt resistors are switched to 


ground to obtain different levels of attenuation. 





a ——————— —_ EES — 


Attenuation Level Shunt Resistors Switched to Ground 
0 dB 
-3 dB 















none 
15 
-9 dB 
-12 dB R,, and R,, 


-18 dB 


a es 


17 


-24 dB Ris 


-30 dB Ris, Rie Ryy, and Ry, 


Table 5-2 





3.4.2 Envelope Detector Circuit 

Refer to the Envelope Detector schematic diagram in Appendix 1 for the 
following description. After the preamplifier, the received signal passes through a 
unity gain buffer. This isolates the preamplifier from the envelope detector, and also 
provides the low source impedance that the precision rectifier circuit needs to function 


properly. Up ;, Qo7, Qog, and the low pass filter combination of C,, and R,, are the 
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heart of the envelope detector. Diode D,, protects U,, during large input swings above 
the reference voltage V,,,. Resistors R,, and R,, add bias stability to transistors Q,; 
and Q,5. 

As the input signal at the inverting terminal of U,, goes below the reference 
voltage at the noninverting terminal of U,7, Q,7 is brought into the active region, 
thereby drawing Q,, into the active region which charges capacitor C,,. As the 
difference between the reference voltage and the input signal becomes greater, Q,, and 
Q,, are brought further into the active region which in turn increases the time that 
capacitor C,, charges. When the signal at the inverting terminal of U,, is above the 
reference voltage at the noninverting terminal of U,,, transistor Q,,, and subsequently 
Q,, are cut off. The charge in capacitor C,, is then discharged through resistor R;j,. 
As long as the time constant formed by the combination of C,, and R;, 1s much 
greater then the period of the input signal's carrier frequency, the output taken at C,, 
will be the envelope of the input signal. To ensure operation with very low level 
inputs, U,, 1s chosen to have a large gain bandwidth product and a fast slew rate. 
5.4.3 Logarithmic Compressor 

Refer to the Logarithmic Compressor schematic diagram in Appendix | for the 
following description. Prior to logarithmic compression, we pass the received 
envelope through a noninverting amplifier with a gain of 9 dB to restore the signal 
level that was lost in the envelope detector. To obtain an output that 1s proportional 
the logarithm of the input, we rely on the logarithmic relation between transistor Q,.'s 


voltage and current. By using Q,, in U,,'s feedback loop, the output of the logarithmic 
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compressor Is given by: 


V=- Ra). yf Ro (5-25) 
: Ry J R,,° V+ 


where V, 1s given by: 


a temperature (5-26) 
“ 11600 


Here the temperature is in Kelvin. For room temperature, V; is approximately 0.0259. 
From equation (5-25) we note that for small input signals, the output V, is large, and 
for large input signals, the output V, is small. To set the zero crossing point of the 


logarithmic compressor, we choose R,, such that: 


(5-27) 


With R,, equal to 10 kQ, V+ equal to 10 Volts, and V,,, equal to 8 Volts, R,, is 


sat 
approximately 12.5 kQ. V.,, represents the largest possible input to the logarithmic 
compressor. To set the maximum output level of the logarithmic compressor, we 
chose R,, and R,, such that the minimum input signal of 2 mV produces an output of 
5 volts. This allows us to digitally sample the output of the logarithmic compressor 
directly, without worrying about damaging the 68HC1I's A/D converter. The use of 
the matched transistor Q,, helps stabilize the temperature dependence of V;, and is 
essential to eliminate the dependence upon the reverse saturation current 7, which 


doubles for every 10° C rise in temperature [Millman 1979]. 


By taking the saturation level of the receivers as approximately 8 volts, the 
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dynamic resolution of the receiver 1s approximately: 





Dynamic Resolution = 20 089 | = 72 dB (5-28) 


o-3 


To obtain the full dynamic resolution at the input to the A/D converter, the output of 
Operational amplifier U,, must be capable of going between zero and five volts. We 
would like to restrict the output of U,, to be strictly less then 5.5 Volts to prevent 
damage to the 68HC11's A/D converter in case of a failure in the logarithmic 
compressor. To accomplish this, we step down the main positive supply voltage to 5.6 
volts using a zener diode reference. The maximum output of the CA3130 operational 
amplifier used for U,, is about 0.5 volts below the positive supply voltage, therefore 
the output of U,, is restricted between 0 and 5.1 volts. 
5.4.4 68HC11 Microcontroller 

Refer to the 68HC11 Microcontroller schematic diagram in Appendix 1 for the 
following description. The 68HC11 is run in expanded mode at a clock speed of 
8 MHz. Input/Output ports B and C are used to interface to the external 27HC64 
EPROM and the 62HC64 RAM chips. A 74HC373 multiplexer and a 74HCOO0 NAND 
GATE are used to form the proper address line controls and to transfer data to the 
external memory chips. Port PEO is used for the input to the A/D converter. The 
logarithmically compressed signal passes through a low pass filter to remove any high 
frequency noise, and then is sequentially sampled by the A/D converter. Ports PDO 
and PD] are used for serial data output. A SCL/U 20 mA SAIL-to-low-power-logic 


converter 1S used to convert the 68HC1I's serial data to the SAIL communication 
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protocol. The use of the SAIL communications protocol is beneficial because of it's 
simplicity, and it's ability to communicate with multiple nodes. The rest of port D's 
output lines are tied to the positive supply through 100 kQ2 pull up resistors to prevent 
the output lines from floating. Ports PA3, PA4, PAS, and PA7 are used to control the 
two CD4053 2 channel analog switches which control the attenuator network described 
earlier. The rest of port A's input/output lines, except PAO, are tied to ground through 
100 kQ resistors to prevent the outputs from floating. PAO is left as an external input 
for further development, and is tied to the positive supply through a 100 kQ pull up 
resistor. 

Appendix 2 contains a listing of the program that the 68HC11 executes. 
5.4.5 Power Supply 

In the test receiver, a +10 volt power supply is used to power the preamplifier, 
the envelope detector, and the logarithmic compressor. A secondary +5 volt power 
supply is used to power the 68HC11 microcontroller. The use of a separate power 
supply for the microcontroller prevents high frequency noise generated by the digital 
components from entering the preamplifier. For the -S V that is required by the 
logarithmic compressor, a third supply is used. This provides a better regulated 
negative supply then using a DC to DC voltage converter such as the ICL 7660 to 
generate the required -5 V. Finally, a +12 volt, 300 mA supply is provided to power 
an external GPS receiver. All four power supplies are built on a common circuit 
board and share a common ground bus. Refer to the Power Supply schematic diagram 


in Appendix 1 for the following circuit description. 
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The test receiver uses a standard power cord to connect to external power with 
a one half amp slow-blow fuse to protect the receiver in case of a short circuit. A 
Magnetek Triad F-93X transformer is used to step down the input voltage. Diodes D,, 
through D,, act as a standard full wave bridge rectifier. Voltage regulator U,, is a 
simple three terminal +12 volt regulator used to provide power to the external GPS 
receiver. Capacitor C,, filters the rectified supply voltage to provide an unregulated 
DC voltage to U,,. Capacitors C,, and C,, are bypass capacitors used to reduce noise 
on U,,'s input and output leads. Because of the high current requirements of the 
voltage regulator, U,, is mounted to the chassis bottom for heat sinking. 

Voltage regulator U,, 1s an adjustable four terminal voltage regulator used to 
provide the +10 volts required by the preamplifier, absolute value circuit, and the 
logarithmic compressor. Resistor R,, and capacitor C,, form a low pass filter which 
helps reduce high frequency feedback from the GPS receiver power supply (U,,). Ro, 
also acts as an attenuator, reducing the unregulated DC input voltage to regulator U,,. 
By doing this, the power that U,, has to sink is reduced, increasing U,,'s efficiency. 
Resistors Ro», Ry3, and R,, form the feedback network used by U,, to set the output 
voltage. By using an adjustable voltage regulator, the positive supply voltage can be 
set more precisely, which is needed to maintain sensitive bias points in the logarithmic 
compressor. Capacitors C,, and C,, are bypass capacitors similar to C,, and C,;. 

Voltage regulator U,, is a simple three terminal regulator used to supply the +5 
volts required by the 68HC11 and support systems. Resistor R,, and capacitor C,, 


form another low pass filter which helps isolate the preamplifier from the 68HC11 
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microcontroller. As with R,,, R,; reduces the unregulated DC voltage at the input of 
U,;3, reducing the power that U,,; must sink. Capacitors C,, and C,, are bypass 
capacitors similar to C,, and C,;. The combination of resistor Rj, and LED D,, are 
used as a power indicator, with D,, mounted on the front panel of the chassis next to 
the power switch. 

Finally, voltage regulator U,, is a four terminal, adjustable negative voltage 
regulator that 1s used to provide the -5 volts required for the logarithmic compressor. 
Resistor R,, and capacitor C,, form a low pass filter which converts the rectified input 
voltage to unregulated DC. Resistors Rog, Rog, and R,, form the feedback network 
used by U,, to set the output voltage at -5 volts. As before, C,, and C,, are bypass 
capacitors that help reduce noise the voltage regulator's input and output lines. 

5.5 Test Receiver Performance 

To test the validity of the receiver designed in section 5.4, experiments were 
conducted to measure the actual performance of the preamplifier, envelope detector, 
and logarithmic compressor. 

5.5.1 Preamplifier Performance 

To test the performance of the preamplifier, experiments were conducted to 
measure the preamplifier's actual gain, bandwidth, and thermal noise. To measure the 
gain and bandwidth of the preamplifier, the output of the preamplifier was measured 
for sinusoidal inputs at different frequencies. The results, along with the predicted 
values are plotted in figure 5-8. From figure 5-8 we see that the actual gain of the 


preamplifier at the acoustic beacon's carrier frequency is 86 dB. This is close enough 
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Predicted Gain 
+ Actual Gain (dB) vs Frequency (Hz) 
Figure 5-8 


to the design goal to be acceptable. The loss in gain compared to the predicted gain is 
due to the effects of loading between the various stages and to deviations from the 
nominal values of Y,, and r,. We also note that the actual bandwidth is 120 Hz which 
is slightly larger then the predicted bandwidth. This increase is due to deviations of 
R,, and R,, from their nominal values and is not significant. 

To determine the actual thermal noise of the preamplifier, we short the 
preamplifier's input and measure the root mean square output using a digital 


multimeter. Assuming the preamplifier's noise is normally distributed, we correct the 
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Output measurement to reflect a normal distribution by multiplying by 1.13 [Horowitz 


and Hill 1989]. The preamplifier's thermal noise is then found by using: 


1.13 -e 
é. = : (5-29) 


"A VBW 





where e, is the measured output voltage, A, is the total gain of the preamplifier, and 
BW is the bandwidth of the preamplifier. Using this approach, e, was measured as 
6.8 millivolts. The preamplifier’s thermal noise is then: 


: 19073 
rd 1.13 -6.8 10" z 3] nV / yy Hz (5-30) 
19275 7120 
To check this value we can observe the output of the preamplifier (with the input 
grounded) on an oscilloscope. To measure the preamplifier's noise, we take the peak 


value observed on the oscilloscope. Next we calculate the preamplifier's thermal noise 


using: 


V 6 
e, = V reat | © (5-31) 
A, ~BW 
This gives a rough approximation of the thermal noise of the preamplifier. V,.., was 


measured as 35 mV. Using equation (5-31), the thermal noise of the preamplifier is 
een ent Ve) Thistvalue is of the same order of magnitude as found in 
equation (5-30), so we can assume the noise figure given in equation (5-30) 1s correct. 
5.5.2 Envelope Detector 


To test the performance of the envelope detector we look at the output for 
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different amplitudes of a sinusoidal input. Figure 5-9 shows the measured output of 


the envelope detector for different amplitudes of a 10,000 Hertz sinusoid input. 





“~~ Measured Output (Volts) vs Input (Volts) 
Predicted Linear Relation 


Figure 5-9 


Ideally, the envelope detector should have an output that is linearly dependent on the 
amplitude of the input sinusoid. This allows the envelope detector to accurately track 
the true envelope of the beacon signal. From figure 5-9 we see that the measured 
output is nearly linear, therefore we expect the envelope detector to work properly. 
5.5.3 Logarithmic Compressor 

To test the performance of the logarithmic compressor, we look at the output 
for different DC voltage inputs. Figure 5-10 shows the measured output values and 


the predicted values. 
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“+ Measured Output (Volts) vs Input (Volts) 
_ Predicted Output 


Figure 5-10 
From figure 10 we see that the logarithmic compressor does not follow an exact 
logarithmic relation. However, since the output of the logarithmic compressor 
monotonically decreases throughout the full range of input values, the compressor is 
sufficiently logarithmic to achieve the dynamic resolution of equation (5-28). Since 
we achieve the desired dynamic resolution, the performance of the logarithmic 
compressor is acceptable. 
5.6 Conclusions 

In this chapter a receiver to implement the maximum likelihood estimation 


algorithms developed in chapter II and III was designed and tested. Appendix | 
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contains the schematic diagrams of the receiver built for testing. From the tests 
conducted, we see that the test receiver meets the design criteria developed in section 
5.2. To complete the receiver, an Apple Macintosh personal computer is used for the 
final signal processing and for data display. Appendix 3 contains a listing of the 
source code used by the Macintosh for signal processing and for displaying the 


collected data. 
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Chapter VI 
Conclusion 
6.1 Observations and Summary 
In this thesis, a method to passively localize stationary and linearly moving 
acoustic beacons was developed. Because of the nonlinearities of the structural model 


g(w,, 9), and the errors in the measurements x,, y,, and t,,, the localization problem 


sy 
was formulated as a constrained maximum likelihood estimation problem. To solve 
for the maximum likelihood estimate, a vector of Lagrange multipliers was introduced 
and a Lagrangian function A formed. The maximum likelihood estimate was then 
found at the stationary point of the Lagrangian function. Figures 2-4 and 3-1 
summarize the algorithms used to solve for the maximum likelihood estimate of the 
acoustic beacon's position. Both algorithms require that the user specify the maximum 
range and depth of the search area, and an initial guess of the acoustic beacon's 
location. For the case of the moving beacon, the user must also specify the maximum 
allowed velocity of the acoustic beacon. 

Monte Carlo simulations were conducted for several different positions and 
velocities of the acoustic beacon. It was assumed that the receiving ship followed a 
hexagonal search path with legs of 1000 meters. In practice, the actual search path 1s 
not critical as long as it is not linear. In chapter IV results from six scenarios were 
presented. Overall, the algorithms developed in chapters II and II performed well for 


these scenarios. For a stationary acoustic beacon, good estimates of the acoustic 


beacon's location were obtain using GPS errors of 3 meters and 25 meters rms. For 
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the moving acoustic beacon, a good estimate of the acoustic beacon's location was 
obtained when using GPS errors of 3 meters rms. However, the accuracy of the 
algorithm used to estimate the moving acoustic beacon's location degrades for GPS 
errors of 25 meters rms unless a large number of experiment vectors are used, or a 
large effective sensor spacing is used. 

From the results of the Monte Carlo simulations, it was shown that, in general, 
as the number of experiment vectors (w,) used in the maximum likelihood estimation 
problem increased, or the effective sensor spacing increased, the accuracy of the 
estimated beacon location improved. It was also shown that the accuracy of the 
estimated beacon location improved if the receiving ship passed through a closest point 
of approach to the acoustic beacon. In all cases, the accuracy of the estimated beacon 
position was significantly better when using 3 meter GPS errors. This shows that to 
obtain a better estimate of the acoustic beacon's location, the position of the receiving 
ship must be measured accurately. 

For all scenarios, the variance of the estimated beacon position and velocity 
decreased as the number of experiment vectors used increased, or the effective sensor 
spacing increased. It was found that the variance of the moving beacon's estimated 
position was much greater then the variance of the stationary beacon's estimated 
position. This is due the manner in which the acoustic beacon's initial position and 
velocity are combined in the modified structural model. In the modified structural 
model given by equation 3-10, the individual velocity components are added to the 


initial beacon coordinates x,, y,, and z, to find the location of the acoustic beacon 
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when it transmits a signal. As a result, the algorithm estimates the value of the sum of 
the initial position coordinates and the velocities better then the individual components. 
Consequently, the algorithm can not discern between small perturbations in the 
estimated position coordinates and the estimated velocities. 

From these results, to obtain the best possible estimate of the acoustic beacon's 
position a large number of experiment vectors with a large effective sensor spacing 
must be used. However, the time required to collect the measurement vectors 
increases with both the number of experiment vectors and the effective sensor spacing. 
If the time it takes to obtain an estimate of the acoustic beacon's position is an issue, 
fewer experiment vectors and smaller effective sensor spacings can be used. For the 
hexagonal search path shown in figure 4-1, and a pulse repetition interval of 2 
seconds, a minimum of 20 experiment vectors with an effective sensor spacing of 35 
pulse repetition intervals are required to obtain a decent estimate of the acoustic 
beacon's position for a stationary beacon. For the moving beacon, assuming the same 
search path, a minimum of 30 experiment vectors with an effective sensor spacing of 
45 pulse repetition intervals are required. 

In chapter V design specifications for a receiver to implement the algorithms 
given in chapters II and III were developed. The synchronous time of receipt was 
measured by determining the time of arrival of the acoustic beacon's envelope. To 
determine the arrival time of the acoustic beacon's envelop, the beacon's carrier 
frequency was first removed using a precision rectifier with a low pass filter to form 


an envelope detector. The output of the envelope detector was then logarithmically 
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compressed to increase the dynamic resolution of the receiver. Next, the output of the 
logarithmic compressor was digitally sampled using a 68HC11 microcontroller. 
Following A/D conversion, the sampled envelope was passed through a digital 
matched filtered. For a rectangular windowing function, this produces a unique 
maximum output which was used to determine the time of arrival. Following the 
design specifications, a receiver was built from commonly available components. 
Experiments conducted on receiver showed that the test receiver met the design 


specifications of section 5.2. 
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Appendix 1 
This appendix contains the schematic diagrams for the receiver designed in 


chapter V. 


15] 





"IOfOM “We Siuuaq 


aDD}S 4S4l4 
J9IGwWoIId aS 








MSZ 
904 
aS 
39VLS GNOO3S OL x “609 
NO 
JNO 429 
SOY 
- 79S 
680SNZ mie 
S00 41 
49001 
ye 709 
4310 AML O eo 00 
ALK, Tie 


QNO 


NI sogzyn LNO 
Lon 





at 


SQ 
SOY 


UECs 
LOO 


ABQ 
cOd 


fas. 
MO | 
LlOd 
HStlO'O 
LO] 


49081 
[ee 


yh 


SZ 





y1ofom “W siuuaq 









aDD}S PuddsaS 
JINNGWUdII¢4 


BOW iS Calne 
NON 


site, 
vLO 


QNO 


NI sogzyn 
TON 





aN 


MOG 1 
ela 


FRG 
GOO 


4nNZzZ0'0 YOO! 
LO9 
7 ®. 
Wi 
ans 
4d0¢ 
809 
4no'l 
909 


be 


9O6L NC 
vOO 


ae 
Old 


QO| 
604 


HS1LLOO 


ZS 
A001 qOVIS 
808 {Sul4 WONS 
UA 
4INS1LOO'O 
Coo 
MLY 
LOM 


153 





HIOfOM “Wo suuEeg 


VNILIV ENSLLV 





@60}S ply] 
Jaljyyduioesid 1 
See NOOO 2 Sew aal@ 
A SD Ge 97M TAG) 
= ee 
las 
reall 
por 
= 
en Oa! 
O10 aula 





O01 


Gao YL 


Sly 


68SOSNC 
JOLOS1L 350 900 


Fol Oia Na) OL 
{NOA 


JINGLOO O 
609 


Bei 





CNa ELLY LNSLLV 
AoW PICO EAL) 
mel 
919 GCY vcd GLO 
Wa 
CSOY 
Fon 
AOG 
Old ce 





Vlad 


BOWS 
QNOOHS WOUS 
UlA 


154 





yIfOoM “WW Siuuag 









Ts 
10}9919q 
9 dO|eAuy 
oS 
GNO 
Die 4EI9O'O SAMA 
Io dy STO ae a 
SOSZvn TA 
}NOA SON 
9O06ENC SSIMA 
800 “ 
49081 
Ge VCO BS 
Ocod 






: dad a 2 ee COPXVN 
9 90N 
OLS NS sO) 
- LON IL—$* ur 
6Cd ARO .@ SO! 
CEO 6 ES) 
906ENC SAMA 
L00 


SVILVNI 
LOG 





Beici. 


lS 





4IOM “W siuuEq 


Jossaudwo7 
olWuYyWIDBO7 SON 





vVOBENC 








OLO 
—A 
¢ 
= VES Ory 
+/ 
01 WOLS 249°C 
Spy Cry —/\ = 
4NLO'O a MLZ 
BSS, vey 
ah 9¢% 49S 
cou 
Ocloy on 
HZ 
9 As 
}NOA 3 - a a Jn10°0 
if 
Scg 4d9¢C Eee 
4dZ7Z 001 [eg —/ 
vOo 6ou Isl, 
9 ® 
% Comes - 
T gon ; UIA 
as L 
ie 49100 
TCD 
JO1A ae SAYA 





a5 


156 





419fomM “W Siuuaq j Seas 





; OlS nee 
OH89 
: 47100 . HOO! gy 
Ni a/¥ a er 4001 C4 
a oaix b St 
6rOvOHrZ S rea Ot C+ 
MOL C+ 
usu ps 
ri a SSA 
@ {190 
O0A 
YO | SOBs z 
C+ 
c+ a 
i l 
of 
| OODHPZ Oe old 
(+) L Ni L 
n/10s US 
xa/00d*& 
x1/ 10a} ve 
G+ Ce 
= oo 
rages G+ a a ax 
c+ 
rn 4001 4OOL 
eae or ee 
aa ee 
76 Lv be 
be ine 
ez Cis 
a | CNALLW 
20 [nn eee | a 
CLOOHEL 
X00 L 
T I ENBLIY 
d d 
eer 39° O¢ ZHW 8 S| O¢ pN3SLLV 
! 200 
a LL > He Yoo! 
6rOPOHPZ 6vOrOHPZ 


C+ 


US 





yIOM “W Ssiuueq 





Zs 
Aj\ddnS jeamod 
MLS 
ow 
YZ Es 
JnO" 604 ae 470001 
Zio 01D 
OND 
WLP 
—- pa LNOD 
ALg AS-— ino NI > 
sog S DINOWEZ LOW 
Vax ron 
Picline 
OLt aotg 80) JNOO0! 
904 609 L090 
GND 
ino NI 
oe GZ 
GOSZ Sou 
eon 3) S| 


wTks / = 
POe ¢ . i. 


40 BAe ° snee'o 4n900z 
909 SOO 709 MO18 MOIS 
| ONO dNv S‘0 
ee LNOO 
ZO 
(Oe LNo NI 
ona NBL ae 
han 
4nL'0 a 40002 
010) HOD) 
GNd 
Ww 
vw.008 a 
Clee 


LON 


158 





Appendix 2 


This appendix contains the source code used by the 68HC11. The code is 
based on a full function SAIL driver written by Dr. Albert Bradley and operates under 
serial communication interrupt control. The sampling rate of the A/D converter is set 
by using a Timer Output Compare function. After the microcontroller finishes an 
initialization period, it sits in a wait state until a serial communications interrupt or a 
timer output compare interrupt occurs. Once the interrupt is received, the 


microcontroller executes the requested task, and then returns to the wait state. 


* #PTR Driver 


THE MINIMUM POWER DRAIN IS- 

2.5 MA IF IN WAIT LOOP, 4.9152 MHZ 

6-7 MA IF WORKING, NO LOADS 

ieee cee see ere eS ee CESSES ETS ES ST ECTS SS SSAC AS TEES EEE ES EE TE ES 

; Mon, Sep 17, 1990, 19:21 MINOR CLEANUPS 

; IT CONTAINS- 

-2M AND !M ARE OPTIONAL DEPENDING ON THE 'BIG' FLAG 

-FULL BAUD SWITCH CAPABILITY 

-FULL USE OF EVEN PARITY 

-FULL TTY HANDLES 

re a 2 CEPTS ETE E REECE EEE CES TERE RET EEE EEE ESE CESS EES St 
PROC "68HCII" 

; THIS IS THE CONTROL FOR THE CONDITIONAL ASSEMBLY OF THE !M AND 7M 

SECTIONS 


=] WILL INCLUDE THEM 
=0 WILL EXCLUDE THEM (SAVES $118 BYTES OF CODE) 
LOAD: EQU 1 


VIEW: EQU 1 


? 
EEKEEEEKEKREREEREEEEREKREREKREKREKEREEKREKEKREKREREKREREEEEEREREREREEEEEEEEREERE REE EE EE 
? 


; DEFAULT PARAMETERS 


DBAUD: EQU $30 ‘START UP AT 9600 BAUD WITH 8.0 MHZ XTAL 
SAMPLE: EQU  $07D1 -1.0mSEC SAMPLING RATE (ADJUSTED FOR ERRORS) 
RADBUFF: EQU $3000 ‘LOCATION OF RUNNING A/D BUFFER 

ADBFULL: EQU  $300B ‘A/D BUFFER FULL AT 11 VALUES (0-10) 

MAXBUFI: EQU $3100 ‘LOCATION OF BUFFER 1 

MAXBUF2: EQU $3200 ‘LOCATION OF BUFFER 2 


iy 





ATTNINC: 
ATTNDEC: 
MAXIFL: 
MAX2FL: 


2 


EQU 
EQU 
EQU 
EQU 


$E8 
$40 
$3 10F 
$320F 


eo) PENUATOR LEVELS 


DBOO: 
DBO3: 
DBO9: 
DB 12: 
DB18: 
DB24: 
DB30: 


DMAXNUM: 
DPERIOD: 
DWIND: 


> 


EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 


EQU 
EQU 
EQU 


$01 
$09 
$1] 
$19 
$21 
$8] 
$B9 


$02 
$07D0 
$0014 


sSINCREASE ATTN AT 4.75 VOLTS 

INCREASE THE PREAMP GAIN AT THIS LEVEL 
s;CHECK VALUE TO INITIALIZE MAX BUFFER 
;CHECK VALUE TO INITIALIZE MAX BUFFER 


; 0 DB ATTEN 
; 3 DB ATTEN 
; 9 DB ATTEN 
512 DB ATTEN 
318 DB ATTEN 
324 DB ATTEN 
330 DB ATTEN 


sDEFAULT NUMBER OF MAX POINTS TAKEN 
sDEFAULT TO 2 SECOND PERIOD 
sDEFAULT INDEX WINDOW 


EKEKEKEEKEKEKEKEEEEEEKEKEKEEEECE REE EEEEEREKREREREREREREREREREEEEREEEEEEEEESEEE EEE SE 
> 


RP: 
PORTA: 
PORTC: 
PORTB: 
DDRC: 
PORTD: 
DDRD: 
PORTE: 


CFORC: 
OCI1M: 
OCI1D: 
TCNT: 
DTIC1: 
DTIC2: 
DTIC3: 
DTOC1: 
DTOC2: 
DTOC3: 
DTOC4: 
DTOCS: 
GT 1: 
eT 2: 
TMSKI1: 
TFLGI: 
TMSK2: 
TFLG2: 
PACTL: 
PACNT: 
SPCR: 
SPSR: 


EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 


EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 


$0000 
RP+$00 
RP+$03 
RP+$04 
RP+$07 
RP+$08 
RP+$09 
RP+$0A 


RP+$0B 
RP+$0C 
RP+$0D 
RP+$0E 
RP+$10 
RP+$12 
RP+$14 
RP+$16 
RP+$18 
RP+$1A 
RP+$1C 
RP+$1E 
RP+$20 
RP+$2 1 
RP+$22 
RP+$23 
RP+$24 
RP+$25 
RP+$26 
RP+$27 
RP+$28 
RP+$29 


;REGISTER PAGE ON BASE PAGE 
1OC1.0C2.0C3.0C4!0C5.IC1.1C2.1C3| 


? 


> 


|X.X.SS.SCK!MOSI.MISO.TXD.RXAD| 


|V7.V6.V5.V4!X.X.X.BRK] 

‘-BAT.BAUD. 

sTIMER COMPARE FORCE REGISTER 
;OUT COMP 1 MASK REG 

;OUT COMP 1 DATA REG 

sTIMER REGISTER (HIGH BYTE) 

sTIMER INPUT CAPTURE 1 (HI BYTE) 
sTIMER INPUT CAPTURE 2 (HI BYTE) 
;TIMER INPUT CAPTURE 3 (HI BYTE) 
sTIMER OUTPUT COMPARE 1 (HI BYTE) 
STIMER OUTPUT COMPARE 2 (HI BYTE) 
STIMER OUTPUT COMPARE 3 (HI BYTE) 
“TIMER OUTPUT COMPARE 4 (HI BYTE) 
“TIMER OUTPUT COMPARE 5 (HI BYTE) 
sTIMER CONTROL REG 1 

“TIMER CONTROL REG 2 

>TIMER INTERRUPT MASK REG 1 
“TIMER INTERRUPT FLAG REG 1 
“TIMER INTERRUPT MASK REG 2 
-TIMER INTERRUPT FLAG REG 2 
-PULSE ACCUMULATOR CONTROL REG 
“PULSE ACCUMULATOR COUNT REG 
‘SPI CONTROL REGISTER 

;SPI STATUS REGISTER 
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SPDR: 
BAUD: 
SCCRI: 
SCCR2: 
SCSR: 
SCDR: 
ADCTL: 
ADRI1: 
ADR2: 
ADR3: 
ADR4: 


OPTION: 
HPRIO: 
INIT: 


2 


EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQU 


EQU 
EQU 
EQU 


RP+$2A 
RP+$2B 
RP+$2C 
RP+$2D 
RP+$2E 
RP+$2F 
RP+$30 
RP+$3 1 
RP+$32 
RP+$33 
RP+$34 


RP+$39 
RP+$3C 
RP+$3D 


sSPI DATA REGISTER 


,[RAM3.2.1.0!REG3.2.1.0] 


KEKEKKKKKEKEKEKKEEKEEKEKREREKRERERKEKEEEKKEKEEKEKEKREKREKEKEEKEEEKEKEEKEKKKEKEKKKKEKKKKEK EK KK 
? 


; SAIL inteface RAM workspace 


RJUMP: 
RVECT: 


X JUMP: 
XVECT: 


JUMP2: 
Wie T 2: 


SCRTCHI1: 
SCRTCH2: 
SCRTCH3: 
SCRTCH4: 
per 1 CHS: 


Poll) Y : 


Cy) 
> 


EQU 
EQU 


EQU 
EQU 


EQU 
EQU 


EQU 
EQU 
EQU 
EQU 
EQU 


EQU 


$40 
$41 
$42 
$43 
$44 
$45 
$46 
$47 
$48 
$49 
$4A 
$4B 
$4C 
$4D 


$4E 
$4F 


“JUMP INST GOES HERE.. 
: HI 

é LO 

‘-XMIT JUMP INST 

: HI 

2 LO 

s2ND JUMP INST 

: HI 
2 LO 
“SCRATCH LOC 1 
“SCRATCH LOC 2 
“SCRATCH LOC 3 
“SCRATCH LOC 4 
SCRATCH LOC5 


sTTY POINTER HI 
LOW 


EEKEKKEKEKEKEKEKEKEREKEEEEKEEEKEKEEEKEKEKKEEEEKEKEKEKEEKEEEKEEKEEKEEKEKREKEKEKEKEE SE 
) 


; PTR Data inteface RAM workspace 


PERINDX: 


PERIOD: 


MAXBUFF: 


MAXFULL: 


ADBFPTR: 
TXBUFF: 


TXBFULL: 


EQU 
EQU 
EQU 
EQU 
EQU 
EQU 


EQU 


$50 
$51 
$52 
$53 
$54 
$55 
$56 
$57 
$58 
$59 
$SA 
$5B 
$5C 


;sPERIOD TIMER INDEX HI 
LOW 
LENGTH OF PERIOD fl 
LOW 
;MAXIMUMS BUFFER LOCATION HI 
LOW 
;MAX BUFFER FULL LOCATION HI 
LOW 
sRUNNING A/D BUFFER LOCATION HI 
LOW 
sMAXIMUMS BUFFER TO TX HI 
LOW 
;5TX BUFFER FULL LOCATION HI 
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TXIFLG: 


$5D 
35 
$5F 


$60 
$61 
$62 
$63 
$64 
$65 
$66 
$67 
$68 
$70 
$72 
$74 
$76 
$78 


LOW 
sFIRST MAXIMUMS SENT FLAG 
SSECOND MAXIMUMS SENT FLAG 


;WHICH MAXIMUM BUFFER TO SAVE FLAG 
sMANUAL GAIN CONTROL FLAG 

sLARGEST A/D VALUE PER PERIOD LOCATION 
;NUMBER OF MAXIMUMS LOCATION 
;TRANSMIT OUT BUFFERS 


SINTERM STORAGE FOR TX POINTER 
SINTERM STORAGE FOR MAXIMUM INDEX 
SINTERM STORAGE FOR MAXIMUM 
sSMAXIMUM CHECK WINDOW SIZE 

SUSED FOR TESTING IF WITHIN WINDOW 


3 


REKEKERKKEKEREKEKEKKKKEKKEKKEKKKEEKKEKKEKEKEEKKERKEARKEKKKEKKEKKEEKRKEKRKKEKEKKKEKKEK KE 
9 


SASSUME 27C64 EPROM 


"HDTR" 
$00 


SAIL ADDRESS 
;s TERMINATOR 


KKEEKKERKEKEKKEKEKEKKEKKEKEKEKEKKEKEKKEKEKRKEEEEKEKEEKKEKEKEKEKEEEKEKEKEKEEKEKEKEKEKEEKEEKKEKEEKEKEKE KE 
> 


$103D 
#SOOFF 


#DBAUD 


BAUD 
SCCRI 
#$2C 


EQU 
TX2FLG: EQU 
MAXFLG: EQU 
AGCFLG: EQU 
BIG: EQU 
MAXNUM: EQU 
TXMHI: EQU 
TXMLO: EQU 
TXIHI: EQU 
TXILO: EQU 
TXINT: EQU 
TEMPIND: EQU 
TEMPMAX: EQU 
WINDOW: EQU 
WINCHK: EQU 
INDXCHK: EQU 
ORG = $E800 
- SAIL Address stored here.. 
ADDR: FCB 
FCB 
START: SEI 
CLR 
LDS 
LDAA 
STAA 
SIAR 
LDAA 
STAA 


SCCR2 


sMOVE REGISTERS TO BASE PAGE (00-> INIT) 
SET STACK POINTER 
SET DEFAULT BAUD 


38 DATA BITS, WAKE ON IDLE? 
ONE COREG INTERRUPTS VED 


HREKREEKEKEEERKKEKEKEEKERKEKKEKEKKEREEREEKERKEKREKEKKEKERERKKEKEKEREREREEKE & ES 
> 


; PTR TIMER INTERRUPT INITIALIZATION 


LDAA 
STAA 
CLR 
LDAA 
STAA 
LDAA 
STAA 
LDAA 
STAA 
CLR 
CLR 
CLK 
CLR 
CLR 
CER 


#$40 
TCTL] 
TMSK2 
#$90 
OPTION 
#$20 
ADCTL 
#$88 
PACTL 
MAXFLG 
TXIFLG 
TAZFLG 
AGCFLG 
BIG 
TXMHI 


;TOGGLE OC2 ON EACH COMPARE 


ET PRESCALE TO/1 
sTURN ON THE A/D CONVERTER 


;USE PEO FOR A/D INPUT, SINGLE CHANNEL, 
s;CONTINUOUS SAMPLING 
;SET PORT A PINS 7 AS OUTPUT 


SINITIALIZE TO FIRST MAXIMUMS BUFFER 
INITIALIZE TO NOT TX'D 

SINITIALIZE TO NOT TX'D 

sSINITIALIZE TO AGC ON | 
SINITIALIZE THE LARGEST VALUE TO ZERO. 
;CLEAR THE OUTGOING BUFFERS 


162 





CLRAD: 


CLMX1: 


CLMX2: 


> 


CLR 
CLR 
CLR 
LDAA 
STAA 
LDD 
STD 
LDx 
STX 
STX 
LDAB 
ADDB 
STAB 
ABX 
STX 
STX 
LDD 
STD 
LDX 
STX 
LDAA 
LDX 
STAA 
INX 
Crx 
BLO 
LDX 
STAA 
INX 
Cr x 
BLS 
LDX 
STAA 
INX 
CPX 
BLS 
LDD 
STD 


TXMLO 
TXIHI 
TXILO 
#DBOO 
PORTA 
#RADBUFF 
ADBFPTR 
#MAXBUF 1 
MAXBUFF 
TXBUFF 
#DMAXNUM 
#DMAXNUM 
MAXNUM 


MAXFULL 
TXBFULL 
#DPERIOD 
PERIOD 
#$0000 
PERINDX 
#$00 
ADBFPTR 
$00,X 


# ADBFULL 
CLRAD 
#MAXBUF 1 
$00,X 


#MAXIFL 
CLMX1 
#MAXBUF2 
$00,X 


#HMAX2FL 
CLMX2 
#DWIND 
WINDOW 


;SET 0 DB OF ATTENUATION 
;SET A/D DATA BUFFER LOCATION IN BASE PAGE 


sSET FIRST MAX BUFFER LOCATION IN BASE PAGE 


;SET THE NUM MAX CHECK VALUE 
SET BUFFER FULL TO 2xDMAXNUM 


‘SET THE PERIOD SIZE 


INITIALIZE PERIOD TIMER TO ZERO 


;CLEAR THE RUNNING A/D BUFFER 


s;CLEAR THE FIRST MAXIMUM BUFFER 


;CLEAR THE SECOND MAXIMUM BUFFER 


SET DEFAULT INDEX WINDOW 


RERKKEEEEEEEE EE KEK ERE EK EKER EEE EERE EERE KER ERE EREREREKREKKEEEEE EEE ERE 
>) 


. 
> 


CLR 
LDAA 
STAA 
STAA 
STAA 
0B) B, 
STD 
STD 
CLI 


SCRTCH1 
#$7E 
RJUMP 
XJUMP 
JUMP2 
#SETUNAD 
RVECT 
XVECT 


;USE AS SAIL MODE FLAG & ADDR POINTER 
sMUST WRITE JMP INSTS. 
sINTO SAIL WORK AREA 


;SET VECTORS TO INITIAL VALUES 


sAND FINALLY ALLOW INTERRUPTS 


EKER KKEKERKEKKEEREEKEREREEKKKEKEKKEEKKEE EERE EKKKEREKKEEKEKEREREKKEKEEE ES 
> 


163 





EEKEKKEKKEKKEKKEKRKKKEEKKKKEKKEKKKREKREERKEKEKRKEKRKRKEKKEKRKRKRKRKKRKKKEKREKREKREKEKEEKEE 
s) 


; MAIN PROGRAM BODY 


LOOP: 


WAI 
BRA 


LOOP 


;WAIT TILL INTERRUPTED.. 


SHEKKEKEKKEKKKEEKKEKEEKEEKEREKEKREKKKKKEKKKRKKKKKRKREKRKEKREKKEKKEKREKKEKREKRKKEKREKEEKES 
= 


REKEKKKEKEEKEREKERKEKEEKERKKEEREKKKKEKEEEKKRKEEEKRKREKKEKEEEKEKEREREKKREREEEKEEKE 
’ 


° 
? 


* TIMER INTERUPT HANDLER 

; Fri, Jul 10, 1992, 13:02 

: Wed, Jul 22, 1992, 8:35 

: Fr, Apr 23, 1993, 9:12 

2 lin: May 20, 1993, 1:52 PM 


TII: 


Tl2: 


SUMMING: 


LDD 
ADDD 
STD 


LDAA 
SUBA 
CMPA 
BLO 
STAA 


LDX 
STAA 
INX 
CPX 
BEO 
LDX 
STX 


LDX 
EY. 
LDAB 
ABY 
INX 
CPX 
BLO 


LDX 
LDD 
STD 
CED 


BHI 

CRY. 
BLO 
STY 
LDD 
STD 
BRA 


DTOC2 
#SAMPLE 
DTOC2 


#SFF 
ADR1 
BIG 
TI 
BIG 


ADBFPTR 
$00,X 


#ADBFULL 
TI2 
#RADBUFF 
ADBFPTR 


#RADBUFF 
#$0000 
$00,X 


#ADBFULL 
SUMMING 


MAXBUFF 
PERINDX 
TEMPIND 
WINDOW 


TH1_11 
$00,X 
Pil 2 
$00,X 
TEMPIND 
$10,X 
TIENDJ 


;SGET LAST VALUE IN TOC2 
;AND ADD ONE PERIOD TO IT 
;SSTORE BACK IN TOC2 


sNORMALIZE THE A/D VALUE 


JS A/D VALUE GREATER THEN BIG? 
IF IT IS STORE IN BIG ELSE MOVE ON 


;GET THE CURRENT A/D POSITION 

STORE THE VALUE 

SUPDATE THE POINTER 

;CHECK IF AT LAST A/D STORAGE LOCATION 
31F NOT INC ADBPTR AND MOVE ON 

SIF YES REINITIALIZE ADBPTR AND MOVE ON 
SSAVE THE A/D STORAGE POINTER 


s;GET THE A/D BUFFER LOCATION 
SINITIALIZE THE SUMATION VALUE 

;GET THE A/D VALUE TO ADD 
sSUM=SUM+A/D 

;SCONTINUE UNTIL ALL VALUES IN THE A/D 
;BUFFER ARE SUMMED 


;GET THE BUFFER TO WRITE TO 
;sSETUP FOR TESTING MAX VALUES 


;SEE IF THE MAX IS CLOSE TO THE START OF 
THE PERIOD 

31F NOT MOVE ON, OTHERWISE 

;CHECK FOR A NEW MAXIMUM 

;IF NOT GOTO CHECK FOR SECONDARY MAX'S 

SIF YES JUST REPLACE CURRENT MAX 
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mile 11: 


Tai 12: 


TIENDS: 


1: 


TUE 


ADDD WINDOW 


CPD 
BLO 
GEG 
BLO 
STY 
LDD 
STD 
BRA 


LDD 
SUBD 
STD 
CRY 
BLO 
CPD 
BHI 
STY 
LDD 
STD 
BRA 


LDD 
Shy 
STD 
EDy 
LDD 
STD 
STY 
LDY 
INX 
INX 
CPX 
BLO 
BRA 


LDD 
ADDD 
STD 
INX 
INX 
CPX 
BHS 
CE 
BLO 
LDD 
6) 4D) 
BLO 
LDD 
SUBD 


PERIOD 
milytae 
$00,X 
Tile? 
$00,X 
TEMPIND 
$10,X 
TIENDJ 


PERINDX 
WINDOW 
WINCHK 
$00,X 
TI1_2 
$10,X 
TI1_1 
$00,X 
TEMPIND 
$10,X 
TIEND 


$00,X 
$00,X 
TEMPMAX 
$10,X 
TEMPIND 
$10,X 
TEMPIND 
TEMPMAX 


MAXFULL 
THI 
TIEND 


$10,X 
WINDOW 
INDXCHK 


MAXFULL 
TIEND 
$00,X 
Tae 
TEMPIND 
INDXCHK 
TIEND 
PERIOD 
PERINDX 


SSEE IF THE MAX IS CLOSE TO THE END OF PERIOD 
sI[F NOT MOVE ON, OTHERWISE 
;CHECK FOR A NEW MAXIMUM 


IF NOT GOTO CHECK FOR SECONDARY MAX'S 
IF YES JUST REPLACE CURRENT MAX 


;CHECK FOR A NEW MAXIMUM 

IF NOT CHECK FOR SECONDARY MAX'S 
;CHECK IF WITHIN WINDOW 

sIF NO REPLACE ALL MAX'S 

IF YES JUST REPLACE CURRENT MAX 


;SHIFT ALL OLD MAX'S ONE LOCATION AND 
sSSAVE THE NEW MAX VALUE 


‘SHIFT THE INDICIES 


sSINCREMENT TO THE NEXT MAX 


»SEE IF DONE 


;CHECK FOR SECONDARY MAX'S 
;SET UP INDEX WINDOW 


sMOVE TO THE NEXT MAX 


sSEE IF DONE 


;LOOK FOR NEW SECONDARY 


-IF WITHIN THE WINDOW OF THE LARGER MAX 
sSIGNORE THE VALUE 
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TI1_ 3: 


TIEND: 


ly: 


TI8: 


D: 


sIF ON THE SCREEN WRAP IN WINDOW IGNORE 


IF WITHIN THE WINDOW OF THE SECONDARY 


JUST REPLACE THE ONE VALUE 


;ELSE REPLACE AND SHIFT OLD VALUES DOWN 


;GET THE PERIOD COUNTER AND INCREMENT 


31S THE PERIOD COMPLETED? 


sARE WE IN MAXIMUMS BUFFER 1 OR 2? 
;CLEAR BUFFER 1 TX'D FLAG 
;CLEAR BUFFER 2 TX'D FLAG 


sUPDATE THE BUFFER TO USE 


;UPDATE THE FULL BUFFER VALUE 

sIF MANUAL GAIN SET DON'T CHECK AGC 
;sTEST IF GAIN NEEDS TO BE DECREASED 

;IF NOT MOVE ON 

;GO TO ATTN FOR MORE ATTENUATION 


;sTEST IF GAIN NEEDS TO BE INCREASED 
-IF NOT MOVE ON 


CPD WINDOW 
BLO  TIEND 
LDD PERINDX 
SUBD WINDOW 
CPD $10,X 

BHI TI1_3 

STY  $00,X 
LDD PERINDX 
STD $10,X 
BRA TIEND 
LDD $00,X 

STY  $00,X 

STD TEMPMAX 
LDY  $10,X 
LDD TEMPIND 
STD $10,X 

STY | TEMPIND 
LDY TEMPMAX 
INX 

INX 

CPX | MAXFULL 
BLO TI3 
LDX PERINDX 
INX 

CPX PERIOD 
BLO Till 

INC MAXFLG 
BRCLR MAXFLG,$01,TI7 
CLR TXIFLG 
LDY #MAXBUF2 
BRA TIB8 

CLR  TX2FLG 
LDY #MAXBUFI 
STY |MAXBUFF 
LDAB MAXNUM 
ABY 

STY | MAXFULL 
BRSET AGCFLG,$01,TI10 
LDAA BIG 
CMPA #ATTNINC 
BLO TI9 

ISR. ATTN 
BRA TII10 
CMPA #ATTNDEC 
BHI THO 

ISR INC 


;GO TO INC FOR LESS ATTENUATION 
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TI10: 


TI11: 


* 
> 


GLE 


LDX 
STX 
LDAA 
STAA 
RTI 


BIG 


#$0000 
PERINDX 
#$40 
TFLG1 


sRESET BIG FOR NEXT PERIOD 
s;CLEAR THE PERIOD COUNTER 


sRESET TIMER FLAGS 


EERE AAR ERE REE EEE 
>] 


; SCI INTERRUPT HANDLER (SAIL DRIVER) 

; Sat, May 12, 1990, 20:34 COMPACT BY 20 BYTES BY USING RSET: 

: Sun, May 13, 1990, 12:36 COMPACT BY USING CONDITIONAL ASSEMBLY 
: Sun, May 13, 1990, 12:37 AND BY USING TTY FOR PROMPT 


SCI: 

-& 
ECHO: 
SCIXIT: 


3 
* 


ATXIT: 


CKCHAR: 


LDAA 
ANDA 
BEQ 
LDAA 
NOP 
RTI 


BRSET 
LDAA 

ANDA 

BNE 


LDAA 
TAB 
LDX 
ABX 
LDAB 
BNE 
ANDA 
TAB 
CMPA 
BEQ 
JMP 


JMP 


Mon, Sep 17, 1990, 19:20 ADD IN4 TO TTY 
BRCLR SCSR,$0E,CKCHAR 


sTEST FOR VALID CHAR 


SCSR sTEST OR.NF.FE 

#$0E 

CKCHAR s[F GOOD, GO ON.. 

SCDR ;READ BAD CHAR TO CLEAR? 
; RECEIVE AN ECHO CHARACTER (& IGNORE!) 
; & EXIT 

SCSR,$20,READD 

SCSR ;sTEST DA 

#$20 

READD 

CHECKX SIF NOT, XMIT 

SCDR ,READ DATA TO A.. 
;AND COPY TO B 

#PARITY ;sPOINT PARITY TABLE 
;sPOINT INTO PARITY TABLE 

O,X ;GET PARITY WORD 

SCIXIT sREJECT IF NOT EVEN PARITY 

#$7F sELSE REMOVE PARITY FOR SUBSEQUENT TESTS 
“ALSO COPY TO B) 

#'#" IS tha? 

GOTNUM 

RJUMP sELSE GO THRU VECTOR 

SCIXIT ;NO FURTHER USE FOR THIS CHAR, EXIT 


; SAIL ADDRESS RECOGNIZE SECTION 


GOTNUM: 


(& 


. 
»2 


LDAB 
STAB 
BCLR 
LDAA 
ANDA 
STAA 
LDD 


#01 
SCRTCH1 


SCCR2,$D2 


SCCR2 
#$2C 
SCCR2 


#READAD 


; GOT # CODE 

;SET SAIL FLAG TO 01 

;TURN OFF XMIT INTERRUPTS 
sTURN OFF XMIT INTERRUPTS 


;sPOINT READ ADDRESS 
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RSET: 


READAD: 


TRYADD: 


SETUNAD: 


UNADDR: 


eos 1: 


NEXTAD: 


GOTADDR: 


° 
> 


STD 


LDAB 
CMPB 
BNE 
CMPA 
BEQ 


DPS 
ABX 
CMPA 
BEQ 


LDD 
STD 


CLR 
BCLR 
LDAA 
ANDA 
STAA 
LDD 
STD 


INX 
INC 
TST 
BEQ 
JMP 


LDD 
JMP 


RVECT 
SCIXIT 


SCRTCH1 
#$0 1 
TRYADD 
#'0' 
TSTBAUD 


#ADDR 


0,X 
NEXTAD 


#UNADDR 
RVECT 


SCRTCH1 
SCCR2,$D2 
SCCR2 
#$2C 
SCCR2 
#XPASS 
AVEC 
SCIXIT 


SCRTCH1 
0,X 
GOTADDR 
SCIXIT 


#CONCHAR 


RSET 


»-MAY ENTER HERE FROM MANY OTHER PLACES 
SAND EXIT 


;GET SMODE COUNT 
IS THIS THE FIRST CHAR? 


SIF FIRST, IS IT ‘0? 
IF SO, MAY BE BAUD SWITCH 
;CONTINUE ON BELOW... 

,;ELSE POINT X TO ADDR 
sADD TO X 
;COMPARE NEW CHAR TO A 
sIF MATCH, LOOK FOR NEXT IN LIST 


sELSE SET UNADDRESS STATE 
;CLEAR SAIL MODE TO 00 

;TURN OFF XMIT INTERRUPTS 
STURN OFF XMIT INTERRUPTS 


SET XMIT VECTOR TO PASS 


;sPOINT NEXT ADD CHAR 
((& INC COUNTER) 
TEST IT, 

; TERMINATOR? 

sELSE SAME VECTOR 


;REC CONTROL CHAR NEXT.. 


; TEST FOR BAUD CHANGE COMMAND 


TSTBAUD: 
BAUD2: 


> 


LDD 
JMP 


CMPA 
BEQ 
JMP 


#BAUD2 
RSET 


#'0' 
BAUD3 
SETUNAD 


;GOT SECOND 0? 


; COME HERE IF GOT #00 (BAUD CHANGE) 


BAUD3: 


BAUD4: 


LDX 
STX 
LDD 
JMP 


LDX 
CMPA 


#SCRTCH1 
VECT2 
#BAUD4 
RSET 


VECT2 
He ' 


sPOINT TO 5 CHAR BUFFER 
SSAVE AT VECT2 


;GET POINTER 
IS IT SPACE? 
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BAUDS: 


BAUD6: 


> 


BNE 
LDAA 
STAA 
INX 
CPX 
BEQ 
x 
JMP 


LDX 
CPX 
BNE 


BAUDS5 
#'0' 
O,X 


#SCRTCH1+5 


BAUD6 
VECT2 
SCIXIT 


SCRTCH1+3 


#$3030 
WAITBRK 


;-CHANGE SPACES TO 0'S 
STORE CHAR 

SADVANCE POINTER 

;PAST END OF 5 CHAR BUFFER? 


IF NOT DONE, SAVE POINTER 
SAND GET MORE 


;GET LAST TWO CHARS 
SARE LAST TWO CHARS BOTH 0? 
IF NOT VALID, SET UP TO WAIT FOR BREAK 


; IF LAST TWO CHARS ARE 00, CHECK BUFFER AGAINST DATA TABLES FOR A MATCH 


e 
> 


LDD 
STD 


#BAUDTBL 


VECT2 


SET UP TABLE POINTER 
;AND STORE IN JUMP2 VECTOR 


; TRY EACH TABLE SEPARATELY, 00 AS IST CHAR SIGNALS END OF TABLE 


BTIRY: 


. 
> 


;GET TABLE POINTER 
; AND TABLE ELEMENT 
; IF=00, WAS NO MATCH, WAIT FOR BREAK 


; COMPARE BUFFER WITH ONE TABLE ENTRY 


; COMPARE EACH CHARACTER 


COMPARE: 


CMATCH: 


NOMATCH: 


WAITBRK: 


LDX  VECT2 
LDAA 0,X 

BEQ  WAITBRK 
LDX  #SCRTCHI 
STX XVECT 
LDX XVECT 
LDAA 0,X 

INX 

Sie X VEGI 
LDX  VECT2 
CMPA_ 0,X 

BNE NOMATCH 
INX 

LDAA_ 0,X 

BEQ MATCH 
STX  VECT2 
BRA COMPARE 
INX 

LDAA_ 0,X 

BNE NOMATCH 
INX 

INX 

STX  VECT2 
BRA BTRY 
LDAA #$0C 
STAA SCCR2 
JMP SETUNAD 


SINIT BUFFER POINTER TO TOP 
; & SAVE IN XMIT JUMP VECTOR 


;GET BUFFER POINTER 

; TO GET BUFFER CHAR TO A 

; INX BUF POINT WHILE WE'RE HERE 
; & SAVE.. 

sNOW GET TABLE POINTER 

; & USE TO COMPARE CHARS 


sIF MATCH, MOVE AHEAD TABLE POINTER 
;sLOOK AT NEXT TABLE ELEMENT 

; IF IT'S 00, FULL MATCH! 

; ELSE SAVE TABLE POINTER 

; AND TRY NEXT CHAR 


SINC TABLE POINTER 

;AND LOOK FOR 00 

;sLOOP TILL IT'S FOUND 

INC OVER NULL 

; & BAUD SET BYTE 

;AND REPLACE TO HOLDING LOCATION 
;GO BACK TO CHECK NEXT TABLE 


;sTURN OFF SCI INTERRUPTS 


; (REQUIRES TOF INTERRUPT TO RESTART) 
;AND SET VECTORS FOR NEW ADDRESS.. 
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;*BAUD* ALL LINES WITH THIS ITEM ARE MODIFIED FOR EACH BAUD GROUP 
; MATCH TABLE FOR BAUD RATE SWITCH 


BAUDTBL: ECB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 


MATCH: INX 
LDAA 
STAA 


See ee es O28 ee BB Oe te eee eB SSE ee Se eee 


'096',$00,$30 ; 9600 *BAUD* 
'048',$00,$3 1 ; 4800 BAUD *BAUD* 
'024',$00,$32 ; 2400 *BAUD* 
'0.12',$00,$33 ; 1200 *BAUD* 
'006',$00,$34 ; 600 7BAUD* 
'003',$00,$35 ; 300 *BAUD* 
$00 ;DONE 


sPASS 00 TERMINATOR 


0.x CEI BAUD BYTE 
BAUD SAND RE-WRITE 
SETUNAD ;AND PREPARE FOR NEW ADDRESSING... 


; 27M COMMAND - DATA INPUT SECTION 


if 


QUERYM: LDD 
JMP 


SAVEADD: LDD 
STD 
LDD 


STARTL: LDD 
BNE 


STARTL2: LDD 
STD 
BSET 
5& LDAA 
z ORAA 
: STAA 
JMP 


VIEW 


#SAVEADD ;NOW INPUT ADDRESS 


IN4 

SCRTCHI1 sSGET ADDRESS, 

SCRTCH3 ;<& SAVE IN ADDRESS POINTER 
#STARTL 

IN4 HEN GET LENGTH 

SCRTCH1 ,IF LENGTH NE 0000 

STARTL2 ; CARRY ON.. 

PROMPT ELSE QUIT 

#ECHO ;PREPARE TO IGNORE ECHO CHARS 
RVECT 

SCCR2,$E0 sSSTART XMIT INTERRUPTS 
SCCR2 

#SEO START XMIT INTERRUPTS 
SCCR2 

OUTLINE ;& SEND A LINE.. 


; «fHE 7M DUMP IS STORED IN THE XMIT SERVICE SECTION BELOW 


else 


endif 
> !M SECTION 

IF 
BANGM: LDD 

JMP 


KEEPADD: DIB: 


LOAD ;CONDITIONAL ASSEMBLY OF LOAD M SECTION 


#KEEPADD sSINPUT STARTING ADDRESS 
IN4 


#HIHEX ;WAIT FOR HIGH HEX CHAR 
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HIHEX: 


LOWHEX: 


STASH: 


TERMIN: 


TERMIN2: 


TERMIN3: 


TERMIN4: 


PASSLF: 


PASSLF2:CMPA 


PXIT: 


SETHIHX: 


JSR 
BCS 
ASLA 
ASLA 
ASLA 
ASLA 
STAA 
LDD 


JSR 
BCC 


LDX 
ORAA 
STAA 
INX 
STX 
LDD 


ANDA 
CMPA 
BNE 


CMPA 
BNE 
LDD 


CMPA 
BNE 
LDD 
BRA 


CMPA 
BNE 
LDD 
STD 
LDD 


BNE 
JMP 


LDD 


RSET 


ASCHEX 
TERMIN 


SCRTCH5 


#LOWHEX 


RSET 


ASCHEX 
STASH 
PROMPT 
SCRTCH1 
SCRTCH5 
0,X 


SCRTCH1 
#HIHEX 
RSET 


#$7F 
#$0D 
TERMIN2 
PROMPT 


nay $ 
TERMIN3 
#HIHEX 
RSET 


#':' 
TERMIN4 
#BANGM 
PASSLF 


#' 
TERMIN5 


#SETHIHX 


VECT2 


#PASSLF2 


RSET 


#SOA 
PXIT 
JUMP2 
SCIXIT 


#HIHEX 


SATTEMPT CONVERT TO HEX 
;CHECK TERMINATOR IF NOT.. 


SMOVE OVER NIBBLE 


;CONVERT LOW 

sPROMPT IF BAD SECOND CHAR 
;GET POINTER 

s;SCOMBINE NIBBLES 

ORE I 


“INC & 
“RESTORE POINTER 


sMASK OFF FLAG BIT 
lS CRY 


IS IT SPACE? 


HOG 2) 


SOR ')? 


Ol ER YvET? 


IF YES, EXIT THRU JMP2 
sELSE WAIT FOR MORE CHARS.. 


,IF ‘|| THEN PREP FOR MORE HEX 
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TERMINS: 


JMP 


JMP 


; IN4 HEX DIGITS 
: INPUTS HEX DIGITS TILL TERMINATED BY A SPACE OR 

: BY A CR. (OR BY UNADDRESS). RESULT LEFT AT SCRTCH1,2 
; EXITS THRU JUMP2 WHEN DONE (TARGET IN D ON ENTRY) 


IN4: 


IN4HEX: 


CKEND: 


STD 
CLR 
GLE 
LDD 
JMP 


JSR 
BCS 
PSHA 
LDAA 
LDAB 
ASLD 
ASLD 
ASLD 
ASLD 
STAA 
STAB 
POLA 
ORAA 
STAA 


ANDA 
CMPA 
BEQ 
CMPA 
BEQ 


RSET 


PROMPT 


VECT2 
SCRTCH1 
SCRTCH2 
#IN4HEX 
RSET 


ASCHEX 
CKEND 


SCRTCH1 
SCRTCH2 


SCRTCH1 
SCRTCH2 


SCRTCH2 
SCRTCH2 
SCIXIT 


#$7F 

#{' ’ 
INEXIT 
#$0D 
INEXIT 
SCIXIT 


JUMP2 


;sfO PROMPT IF NOT VALID CHAR 


See Peewee ese ee Se SZ 2 SS HF SSO Se ZS SSF ST STF TSF SFTSTSTFT TFT TSE SEE ERE E62 E2E24628220 


STORE EXIT VECTOR 
;CLEAR INPUT BUFFER 


POINT CHAR RECEIVER 
;CONVERT TO HEX 

IF NOT HEX, CHECK FOR END 
SSAVE.. 

sHI TOA 


SHIFT OVER FOUR 


“RETURN HIGH 

‘AND B 

-RETRIEVE NEW NIBBLE 
‘ADD NEW NIBBLE 

- & UPDATE 


;CLEAN OFF MS FLAG BIT 
Sl SEACE? 

IS IT CR? 

sELSE, GET ANOTHER CHAR 


SIF DONE, CARRY ON THRU VECTOR.. 


; INPUT ONE HEX BYTE AND CONTINUE THRU JUMP2 


INBYTE: 


ASLA 
ASLA 
ASLA 
ASLA 
STAA 
LDD 

JMP 


SCRTCH5 


#INBYTE2 


RSET 


sMOVE OVER 


‘SAVE 
‘POINT TO NEXT SEGMENT 
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INBYTE2: JSR ASCHEX SCONVERT LOW NIBBLE 
BCC SAVEDAT 


JMP SETUNAD sUNADDRESS IF ERROR 
SAVEDAT SORAA SCRTCHS5 ;COMBINE 
JMP JUMP2 SAND CARRY ON THRU VECTOR2 


S22 2 ©2828 22 22 22 28 282 22 2228 22 22282 222522 222 222 22S 228 22 22222 222 2222 2222228282222 2222222 


; NOW CHECK THE TRANSMIT SITUATION 


CHECKX: BRCLR SCSR,$80,KERROR 
8 LDAA SCSR “MAKE SURE XMIT BIT WAS SET 
: ANDA_ #$80 
: BEQ XKERROR 
JMP XJUMP ;GO THRU XMIT VECTOR 


; THESE SEGMENTS ARE ENTERED THRU XJUMP AND XVECTOR.. 
XERROR: NOP -TRIG LOC FOR DIAGNOSTICS 
; XJUMP TARGETS.. 
XPASS: BCLR SCCR2,$D0 
7& LDAA SCCR2 
: ANDA #$2F 
: STAA SCCR2 
JMP SCIXIT 
if VIEW ;a conditional segment 
; OUTPUT A LINE OF DATA (FROM ?M DUMP) 
OUTLINE: LDD #OUTLF *& SET UP TO XMIT 
STD XVECT 
LDAA #$0D “SEND CR 
JMP SETOUT 


SUTLE: LDD #OUTADDR 


STD XVECT 
LDAA #3$0A ;SEND LF 


JMP SETOUT 


OUTADDR: LDD #LOWADDR © ;PREP OUTBYTE XIT 
Sha” VECT2Z 
LDAA SCRTCH3 ;GET HIGH ADDRESS 
JMP OUTBYTE 


LOWADDR: LDD #LOWADD2 sEXIT FROM 2ND OUTBYTE.. 
JMP = XSET 


LOWADD2: LDD #ADDRSP 
STD = VECT2 
LDAA SCRTCH4 sNOW LOW ADDRESS 
JMP OUTBYTE 
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ADDRSP: 


SENDSP: 


OUTDATA: 


DECLEN: 


IpBCLEN?: 


SA YMORE: 


LDD 


EDD 
STD 
LDAA 


LDX 
LDAA 
PSHA 
LDD 
STD 
PULA 


LDD 


LDX 
DEX 
STX 
BNE 


LDX 
INX 
STX 
XGDX 
LSRD 
BCS 


BNE 


#SENDSP -EXIT FROM 2ND OUTBYTE... 
XSET 
HOUTDATA 
XVECT 
#$20 SEND SPACE 
SETOUT 
SCRTCH3 “GET ADDR POINTER 
0,X >TO GET DATA BYTE 
“SAVE 
#DECLEN 
VECT2 ;sPREP XIT VECTOR 
-RETRIEVE DATA BYTE 
OUTBYTE ;>& SEND IT 
#DECLEN2 sEXIT FROM OUTBYTE2.. 
XSET 
SCRTCH1 -GET LENGTH 
-DECREMENT 
SCRTCH1 -& RETURN 
SA YMORE - MORE DATA? 
PROMPT “PROMPT IF DONE 
SCRTCH3 -GET ADDR 
-INCREMENT 
SCRTCH3 ;REPLACE 
-X REG TO ACCD 
-LSB TOC 
OUTDATA SNEXT BYTE NOW IF ODD 
#307 ;CHECK FOR XXX0 (LINE END) 
SENDSP sIF ONLY EVEN, SEND SP 
he ‘IF NEW LINE, SEND CONTINUATION 
GENPAR 
SCDR 
#OUTLINE -& PREP FOR NEW LINE.. 
XSET 


; OUTPUTS A BYTE IN A AS TWO HEX CHARS, EXITS VIA VECT2.. 


OUTBYTE: 


STAA 
LSRA 
LSRA 
LSRA 
LSRA 
JSR 
PSHA 
LDD 


SCRTCHS ‘STASH FOR LATER 
“MOVE OVER 
HEXASC ‘CONVERT 
“AND SAVE.. 
HOUTBYT2 
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STD XVECT 
PULA SRECOVER CHARACTER 
JMP SETOUT 


LDAA SCRTCH5 
ANDA #$0F 

JSR HEXASC 
JMP OUTJMP 


CLEAN UP 


SCONVERT, SEND & JUMP THRU VECT2 


; SEND A PROMPT FROM THE MONITOR, THEN WAIT FOR CHARS 


PROMPT: LDX ~~ #PLIST 
JMP TTYO 

Miers! : FCB = $0D,$0A,":'" SEE,$90, SCRTCH1,$AA 
FDB PJUMP 

PJUMP: LDAA SCRTCHI1 


JMP CONCHAR 
; INITIATE AN OUTPUT SEQUENCE 
SETOUT: JSR GENPAR 
STAA SCDR 
BSET SCCK2°$C0 
5& LDAA SCCR2 
: ORAA #$CO 
; STAA SCCR2 


;SEND FIRST CHAR 


;TURN ON INTERRUPTS IF REQ'D 


LDD 
JMP 


#ECHO 
RSET 


jaan kEAnm, [LO ECHO 


; SENDS ETX & CARRIES ON THRU VECT2 


KELX: 


OUTJMP: 


> 


. 
> 


LDAA 
JSR 
STAA 
JMP 


#$03 


GENPAR 


SCDR 
JUMP2 


SEND ETX 

IMA OE NTER HERE: 
sDRAGON AGAIN? 
;NOW THRU JUMP2 


KEKEKKKKEKEKEKKEKEKEKKEKEEKEEKKEKEKKEKKEEKEKEKEKKEEKEEKEEKEKKKKEKEKES 
> 


ATIN1: 


ATTN2?: 


LDAA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 


PORTA 
#DBO0O0 
ATTN} 
#DBO3 
PORTA 
ATTNF 
#DBO3 
ATTN2 
#DBO9 
PORTA 
ATTNF 
#DB 12 
ATTN3 


;GET THE VALUE IN PORT A 
IS 0 DB SET? 

sIF NO GO ON 

IF YES SET 3 DB 


Dp EE 

IS 3 DB SEI? 

;IF NO GO ON 

“IF YES SET 9 DB 


sEXIT 


IS 12 DB SET? 
sIF NO GO ON 
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ATTN3: 


ATTN4: 


ATTNS: 


ATTN6: 


ATTNF 


INC: 


INCI: 


INC2: 


INC3: 


INC4: 


MNCS: 


INCF 


LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
BRA 
LDAA 
STAA 
RTS 


LDAA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
CMPA 
BNE 
LDAA 
STAA 
BRA 
LDAA 
STAA 
RTS 


#DB18 
PORTA 
ATTNF 
#DB18 
ATTN4 
#DB24 
PORTA 
ATTNF 
#DB24 
ATTNS5 
#DB30 
PORTA 
ATTNF 
#DB30 
ATTN6 
ATTNF 
#DBO0O 
PORTA 


PORTA 
#DB30 
INC] 
#DB24 
PORTA 
INCF 
#DB24 
INC2 
#DB18 
PORTA 
INCF 
#DB18 
INC3 
#DB12 
PORTA 
INCF 
#DB12 
INC4 
#DBO9 
PORTA 
INCF 
#DBO9 
INC5 
#DBO03 
PORTA 
INCF 
#DBOO 
PORTA 


Jt YES SBT 18 DB 


Selo 

IS 18 DB SET? 

IF NO GO ON 

SIF YES SET 24 DB 


“EXIT 

‘IS 24 DB SET? 

IF NO GO ON 

IF YES SET 30 DB 


EAL 

IS 30 DB SET? 

sIF NO GO ON 

IF YES CAN'T CHANGE ANYMORE 

5IF NON OF THE ABOVE ARE SET, SET 0 DB 


s;GET THE VALUE IN PORT A 
SIS 30 DB SET? 

IF NO GO ON 

sIF YES SET 24 DB 


-EXIT 

‘IS 24 DB SET? 

‘IF NO GO ON 

“IF YES SET 18 DB 


sEXIT 

S18 DB SET? 

IF NO GO ON 

SIF YES SET {2 DB 


sEXIT 

IS 12 DB SET? 
sIF NO GO ON 

JE ES bie? DE 


31S 9 DB SET? 
,IF NO GO ON 
IP YES SE) 3 DE 


-IF NON OF THE ABOVE ARE SET, SET 0 DB 


EERE KEKE ERE RE EEK EEE EE EE AEA EEA EEE EE EEE EEE EEE EE EEE 
3 
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ere tee eves eee se =H oS 


- Converts low nibble in A to ASCII char in A 


HEXASC: ANDA_ #$0F s;CLEAN IT UP 
ADDA #$F6 
BCC HNUMBER 
ADDA_ #$07 ;CONVERT 
HNUMBER: ADDA_ #$3A ; TO ASCII 
RTS 


ewes ee =e Fe SEF SOF Ces MF eS SCM eS FeO TS SSF FSS SS SSS SF S888 S82 S28 SSSSSECSSES 


; Converts ASCII char in A to nibble in A if it is HEX & clears C 
; Otherwise, returns origional char with C bit set. 


ASCHEX: PSHA SSAVE CHAR 
SUBA #$30 
BCS NOTHEX 
SUBA #$0A 
BGE TSTALPH 
ADDA #$0A ;REPAIR NUMB 
BRA AXIT 
TSTALPH: SUBA_ #$07 541->00 ? 
BLT NOTHEX 
SUBA #$06 
BGE NOTHEX 
ADDA #$10 sREPAIR ALPH 
AXIT: INS ;sPOP OFF SAVED CHAR 
CEE SAND CLEAR CARRY BIT 
RTS 
NOTHEX: PULA ;GET CHAR 
SEC ;SET CARRY 
RTS 


Sees e®2 2 @e2@ ee eeEF SG ee ste ee @F2 @e2 2 ®e2 S2e2 22 S222 22 S222 2 ew Bee wee eee2eoeo2 


; GENERATE PARITY- Char is passed in and out thru A 


GENPAR: PSHB SSAVE SOME STUFF.. 
PSHX 
: TAB ‘COPY CHAR TOB 
; LDX  #PARITY ;sPOINT TO PARITY TABLE TOP 
; ABX s;ADD OFFSET TO POINT X TO CHAR 
: ORAA 0,X ;ADD PARITY BIT 
PULX >. RESTORE 
PUES 
RTS 


> 


meeanihY TABLE 


PARITY: FCB $00,$80,$80,$00,$80,$00,$00,$80 5A 
FCB $80,$00,$00,$80,$00,$80,$80,$00 Ve! 
FCB $80,$00,$00,$80,$00,$80,$80,$00 3B 
FCB $00,$80,$80,$00,$80,$00,$00,$80 5A 
; XX20 
FCB $80,$00,$00,$80,$00,$80,$80,$00 3B 
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; XX40 


- XX60 


; XX80 


> XXA0 


CO 


> XXEO 


; CHARACTER 
CHARTBL: 


EEKEKEEEEKEEREREEEKKEEEEKEEEEREEKEKREEKEEEEEEEEEEKEREEEEEEEEEEES 
3 


FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 


FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,500 


FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,380,$80,$00 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 


FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 


FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $80,$00,$00,$80,$00,$80,$80,500 
FCB $00,$80,$80,$00,$80,$00,$00,$80 


FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 


FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 


LOOKUP TABLE 
FCB $41,$42,$43,$44,$45,$46,$47,$00 
FCB $00,$00,$00,$00,$00,$00,$00,$00 


FCB $49,$4A,$4B,$4C,$4D,$4E,$50,$00 


FCB $00,$00,$00,$00,$00,$00,$00,$00 
FCB $51,$52,$53,$54,$55,$56,$57,$00 
FCB $00,$00,$00,$00,$00,$00,$00,$00 


FCB $59,$5A,$5B,$5C,$5D,$5E,$5F,$75 


FCB $00,$00,$00,$00,$00,$00,$00,$00 
FCB $61,$62,$63,$64,$65,$66,$68,$74 
FCB $00,$00,$00,$00,$00,$00,$00,$00 


FCB $69,$6A,$6B,$6C,$6D,$6E,$70,$74 


FCB $00,$00,$00,$00,$00,$00,$00,$00 
FCB $71,$72,$73,$74,$75,$76,$77,$72 
FCB $00,$00,$00,$00,$00,$00,$00,$00 
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> 


w> 


~~ 


we 


: w>>w 


4 


>ww> 


w 


D> > w 


~~ ~~ w 


w 


> >wWw> 


w 


> >ww> 


~~ 


~~ 


> ww > 


°00-07 
-08-0F 
-10-17 
-18-1F 
°20-27 
»28-2F 
30-37 
-38-3F 
540-47 
-48-4F 
°50-57 
>58-S5F 
60-67 
'68-6F 





ged P FILE DUMP 


eteaie LP: 


EDX #HELPFIL 
BRA TTYO 


; A TTY ROUTINE FOR SAIL68 **DO NOT DELETE! USED BY PROMPT ETC!** 
: “USES $FD BYTES 

: -TO ENTER FOR XMIT, LDX #table AND THEN JMP TT YO 

: -TO ENTER IN REC MODE LDX f#table AND JMP TTYRO 

; -MUST USE EE TO SWITCH FROM SENDING TO REC CHARS 

: -CAN GO BACK TO SENDING W/O PROBLEM 

: -ARG TABLE CODES.. 


TRYAA: 


TRYASC: 


TRY80: 


TRY81: 


ASCII -TYPE IT AND GO ON WITH XMIT INTERRUPTS ON 

00 -BACK TO THE PROMPT 

AA aaaa -JMP TO aaaa WITH XMIT INTERRUPTS STILL ON (USE FDB!) 

80 aa -SEND CHAR AT LOC aa 

8laa -SEND HEX PAIR AT LOC aa 

EE -SEND ETX & WAIT FOR A CHAR (MUST BE FOLLOWED BY 9X) 

90 aa -REC A CHAR AND SAVEIT AT aa 

91aa -REC A HEX PAIR AND SAVE IT AT aa (ABORT TO PROMPT <>HEX) 

94 aa -CLEAR SCRTCH1,2 & WAIT FOR A HEX STRING, PUT AT aa,aat+] 
(ENTRY TERMINATED BY SP OR CR) 


ox XTTY ‘LOAD X FROM STORAGE LOCATION 
LDD 4#TTY ‘SET REENTER VECTOR 

STD XVECT 

LDAA 00,X -GET ARGUMENT 

BNE TRYAA 

JMP = PROMPT ‘IF =00, GO DIRECTLY TO PROMPT.. 
CMPA #$AA 

BNE TRYASC 

INX 

LDX 0,X ‘VECTOR TO X 

JMP 0X -AND JUMP TO M(X) 

TSTA 

BMI  TRY80 -IF MSB IS 1, NOT ASCII. 

JSR‘ LBISX -ELSE GET THE ASCII IMM CHAR 
TBA 

JMP  SETOUT -GO SEND IT NOW 

CMPA #$80 ‘REQ IND CHAR? 

BNE  TRY81 

INX 

JSR _—LBISX -GET THE ADDRESS (ASSUME BASE PAGE) 
JSR CRADDR -CREATE ADDRESS 

LDAA 0,X -GET THE IND DATA 


JMP SETOUT 


CMPA #$81 sREQ IND HEX PAIR? 
Bie.) TRYEBE 
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LY 2: 


iis Y EE: 


TRERR: 
PROMPT 


GOTEE: 


° 
SPSS PSVSESTSISIS So = 


INX 
JSR 
JSR 
LDD 
STD 
LDAA 


LDD 


CMPA 
BEQ 


LBISX 
CRADDR 
HTT Y 2 
VEC 
0,X 
OUTBYTE 


#TTY 
XSET 


#S$EE 
GOTEE 
PROMPT 


XTTY 
#$03 
GENPAR 
SCDR 
SCCR2,$C0 
#TT Y3 
RSET 


#$03 
TTY4 
SCIXIT 


#TTYR 
RSET 


-GET THE ADDRESS (ASSUME BASE PAGE) 
-CREATE ADDRESS 

-THEN SET UP VECT2 EXIT PATH 

-GET THE IND DATA NOW 

-EXIT PATH FOR VECT2 STUFF.. 

(ALLOWS OUTBYTE TO RETURN TO TTY) 

-SEND ETX & GO TO RECEIVE MODE? 

IF NOT VALID OUT GROUP CONTROL CHAR, JUST 
‘SWITCH TO INPUT MODE 


SSAVE THE CONTROL TABLE POINTER 
;sSEND ETX 


;»STOP FURTHER XMIT INTERRUPTS 
; AND PREPARE TO RECEIVE THE ETX ECHO 


SGOT ETX YET? 
; KEEP WAITING TILL IT ECHOS 


,WHEN GOT ETX, PREP TO REC DATA CHARS 
; SET RVECT TO TTYR AND EXIT 


; TTY RECEIVE SECTION, ENTER HERE FROM COMMAND CHAIN W/O NEW CHAR 


TTYRO: 


STX 
BRA 


XTTY 
TT Y4 


JUST SAVE TABLE POINTER 
; AND GO GET A NEW CHAR 


; ENTER HERE FROM RVECT WITH DATA CHAR IN A 


TTYR: 


TRY90: 


SAVCHR: 


WRITE) 


TRY9YI1: 


LDX 
JSR 
CMPB 
BNE 
JSR 
JSR 
STAA 
BRA 


CMPB 
BNE 
JSR 
BCS 


XTTY 
LBISX 
#$90 
TRY91 
LBISX 
CRADDR 
0,X 
CKNEAT 


#$9 | 
TRY94 
ASCHEX 
TRERR 


; WHILE WE FIGURE OUT WHAT TO DO WITH IT 
sSGET THE CONTROL CHAR.. 
SSAVE WHOLE CHAR 


IF 90, SAVE WHOLE CHAR AT IMM ADDRESS 
;CREATE ADDRESS 

SSAVE THE DATA BYTE IN M(x) 

;CHECK NEXT CONTROL BYTE FOR TYPE (READ OR 


sSENTER A HEX PAIR? 


;ABORT IF NOT HEX CHAR 
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ASLA 


ASLA ;sMOVE OVER 
ASLA 
ASLA 
STAA SCRTCHI1 SAVE TILL NEXT PASS 
LDD #TTYHEX ;PREP FOR 2ND HEX CHAR 
JMP = RSET 
ley HEX: JSR ASCHEX 3( SECOND HALF OF TRY91 ) 
BCS TRERR ;ABORT IF NOT A VALID HEX CHAR 
ORAA SCRTCH1 ;COMBINE HIGH AND LOW CHARS 
EDXe) XTTY 
JSR LBISX ;GET SINK ADDRESS 
JSR CRADDR ;CREATE ADDRESS 
STAA 0,X 
LDD #TTYR sREPAIR THE VECTOR 
STD RVECT ; AND ON TO CHECK NEXT COMMAND 
BRA CKNEXT 
TRY94: CMPB #$94 IS IT IN4? 
BNE TRERR SQUIT IF NOT A VALID CODE 
GOT94: CIrR. SCRICH! ;GOT FIRST DIGIT IN A, CLEAR INPUT BUFFER 
CLR SCRTCH2 
PSHA SSAVE THE ARGUMENT 
LDD #SAVE4 
Siiee VECT2 sPREPARE EXIT VECTOR 
LDD #IN4HEX 
STD RVECT ;CHANGE RVECT 
PULA 
JMP IN4HEX ;AND PROCESS THE FIRST DIGIT 
SAVE4: LDD #TTYR 
STD RVECT ;sREPAIR THE VECTOR 
ED. ATTY -<GET THE TABLE POINTER 
JSR LBISX ;AND GET THE SINK ADDRESS 
JSR CRADDR s;CREATE ADDRESS 
LDD SCRTCH1 ;AND STORE THE DOUBLE BYTE 
STD 0.x 
BRA CKNEXT ;CHECK NEXT CONTROL CHAR 
CKNEXT: EDX) ATTY 3S THE NEXT CONTROL CHAR AN INP OR OUT? 
LDAA 0,X ;GET THE CONTROL CHAR 
ANDA_ #$F0 ; AND CHECK THE HIGH NIBBLE 
CMPA #$90 JS IT AN INPUT TYPE? 
BNE TTYOL SIF NOT, SWITCH TO OUTPUT MODE 
JMP = SCIXIT sELSE GET ANOTHER CHAR 
ile OL: JMP TTYO 
LBISX: LDAB_  0,X SUBROUTINE TO LOAD B, INC & STR X 


INX ; USED BY TTY ABOVE 
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CRADDR: 


XTTY 


#$0000 


sSUBROUTINE TO CREATE AN ADDRESS 


; AFTER VALID ADDRESS, RECEIVE CONTROL CHAR.. 


CONCHAR: 


GOMON: 
SAYHEL: 
DSCANL: 
TIME: 
TIMOUT: 
RSTARTI: 
AVOUT]: 


ANDA 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
CMPA 
BEQ 
JMP 


JMP 
JMP 
JMP 
JMP 


NOP 
CMPA 
BEQ 


H$7F 

HI" 
SETBG 
H'9" 
SETQG 
#'O' 
TIMEJ 
H'P' 
TIMOUTJ 
ry 
DSCANL 
HA 
ATTCMD 
ys 
GOMON 
#$0D 
GOMON 
HH! 
SAYHEL 
#'R' 
RSTARTJ 
HV" 
AVOUTJ 
SETUNAD 


PROMPT 
SA YHELP 
DSCAN 
TIME 
TIMOUT 
START 
AVOUT 


#BGROUP 
RSET 
#QGROUP 
RSET 
#ATTNGRP 
RSET 


#'T' 
LIES 


;CLEAN OFF FLAG BIT 
Sell) 


OR TS 1a 

1S IT 'O', START DATA COLLECTION? 
IS IT 'P'’, PAUSE DATA COLLECTION? 
1S IT '-'; DATA SCAN REQUEST? 

31S IT‘A’, SET GAIN CONTROL? 
SPACE TO ENTER MONITOR? 

;CHAR RETURN TO ENTER MONITOR? 
All BB cate 

;RESTART? 

SATTEN VALUE REQUEST 
sUNADDRESS IF NOT VALID.. 

sLINK INTO MONITOR 

sLINK TO SAYHELP 

sLINK TO DATA SCAN 

sLINK TO TIME 

;sLINK TO TIMOUT 

sLINK TO START 

sLINK TO ATTEN VAL OUTPUT 
;PREPARE FOR THE CHAR AFTER ! 


;PREPARE FOR THE CHAR AFTER ? 


;PREPARE FOR THE CHAR AFTER A 
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BANGML: 


LTEST: 


QGROUP: 


3 


QUERYML: 


° 
3 


ATTNGRP: 


SETODB J: 
SET1DBI: 
SET2DBI: 
SET3DBJ: 
SET4DB)J: 
SETSDBJ: 


if 


CMPA 


BEQ 
endif 


if 


else 


endif 


LOAD 
#'M' 


BANGML 


PROMPT 


LOAD 
BANGM 


LTEST 


VIEW 
#'M' 


QUERYML 


PROMPT 


VIEW 


QUERYM 


#'0' 
SETODBJ 
#']' 
SET1IDBJ 
#"2' 
SET2DBJ 
#'3' 
SET3DBJ 
#'4' 
SET4DBJ 
#'5' 
SETS5DBJ 
#'6' 
SET6DBJ 
#'A" 
AGCON]J 
PROMPT 


SETODB 

SET03DB 
SETO9DB 
SET12DB 
SET18DB 
SET24DB 


sLINK TO !M 


SLINK TO ?M 


sMANUAL SET 0 DB ATTEN 
sMANUAL SET 3 DB ATTEN 
;MANUAL SET 9 DB ATTEN 
;MANUAL SET 12 DB ATTEN 
sMANUAL SET 18 DB ATTEN 
sMANUDAL SET 24 DB ATTEN 
sMANUAL SET 30 DB ATTEN 


;SSET AGC ON 


sLINK TO SETODB 
sLINK TO SET3DB 
sLINK TO SETO9DB 
sLINK TO SET12DB 
sSLINK TO SET18DB 
sSLINK TO SET24DB 
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SET6DBIJ: 
AGCONI: 


SET30DB 
AGCON 


sLINK TO SET30DB 
;SLINK TO AGCON 


See © SCS SSF SSFSSSSTSSSSSSSSPSVS SV FF SSF S82 ee KF SSF SSF SSF S88 Ge ee eee eeeoe @ 


‘PAUSE REQUEST 


TIMOUT: 


Ci 
LDAA 
STAA 


TMSKI1 
#S$FF 
TFLGI 
PROMPT 


STOPS THE DATA DUMP 
sSDISABLE TOC2 INTERUPT 
sRESET TOC FLAGS 


SSS SSS SS SSSSSSTSSSSTSSSSTSSTSSTSSSSGT TF FFT SF Fe s8 S22 f8 S24 e Sesser seeeeeoee 


START REQUEST 


TIME: 


LDD 
ADDD 
STD 
LDAA 
STAA 


TCNT 
#SAMPLE 
DIO? 
#$40 
TMSKI 
PROMPT 


TURN ON TIMER INTERUPT 
sLOAD THE CURRENT TIMER VALUE 
SSET AN INITIAL DELAY OF 1I.0mSEC 


sTURN ON OC2 INTERUPT 


see e2 eee eee e@e@e@e2 @e2 @ e222 22 Oe Be eB est eZ SSS SSF SSS SS SSS SS S2e82 2e2e8 S2eee2 eo 


; DATA SCAN 


DSCAN: 


DSCANO: 


DSCANI: 


NOT YET: 


NOTRDY: 


DSCAN2?: 


DSCAN3: 


DSCAN4: 


DSCANS: 


DW 


BRCLR TXIFLG,$01I,DSCAN2 
BRCLR TX2FLG,$01,DSCAN3 


LDX 
JMP 
FCB 


BSET 
LDX 
BRA 
BSET 
LDX 
STX 
LDAB 
ABX 
STX 


LD 

STY 

LDAA 
STAA 
LDAA 
STAA 
LDAA 
STAA 
LDAA 
STAA 


LDX 


#DSCANO 
EEG 
SAA 
DSCANI 


# NOTRDY 
TTYO 
$00,$00 


TXIFLG,$0I 
#MAXBUF I 
DSCAN4 
TX2FLG,$01 
#MAXBUF2 
TXBUFF 
MAXNUM 


TXDEUEL 


TXBUFF 
TXINT 
$00,Y 
TXMHI 
$O1,Y 
TXMLO 
$10,Y 
TXIHI 
SII,Y 
TXILO 


#BITSNDI 


SHAS BUFFER I BEEN SENT YET? 
SHAS BUFFER 2 BEEN SENT YET? 
;WAIT UNTIL A BUFFER IS READY 


Et BUFFER Pix DIELAG 


SSET BUFFER 2 TX'D FLAG 


SAVE THE BUFFER TO TX IN TXBUFF 


;GENERATE THE BUFFER DONE VALUE 


;GET THE DATA POINT HI BYTE 
;STORE IN BASE PAGE 

s;GET THE DATA POINT LOW BYTE 
ss TORE IN BASE PAGE 

GET THE INDEX HI BYIE 


s;GET THE INDEX LOW BYTE 


sPREP FOR TX 
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JMP TTYO ;5TX DATA POINT 


BITSNDI1: DB $81,TXMHI,$AA ;TX VIA TTY 
DW DTX]1 

DTX1: LDX #BITSND2 ;PREP FOR TX 
JMP TTYO s1X DATA POINT 

BITSND2: DB $81, TXMLO,$AA ;TX VIA TTY 
DW DTX2 

DTX2: LDX #BITSND3 sPREP FOR TX 
JMP TTYO ;5TX DATA POINT 

BITSND3: DB $81,TXIHI,$AA ;TX VIA TTY 
DW DTX3 

DTX3: LDX #BITSND4 (PREP FOR TX 
JMP TTYO ;TX DATA POINT 

BITSND4: DB $81,TXILO,S$AA ;TX VIA TTY 


DW DSCAN6 


DSCANG6: Gy > YXINT 


INY 

INY 

STY TXINT 

Cry TXBFULL sHAS THE ENTIRE BUFFER BEEN SENT? 


BLO DSCANS5 


LDAA_ #$00 

LDX  TXBUFF ;CLEAR THE BUFFER THAT WAS TX'D 
DSCAN7: STAA $00,X 

INX 

CPX  TXBFULL 

BLO DSCAN7 


LDX #DSCAN8 SEND TX 
IME  TryY0O 
DSCANS: DB $00,$00 
ETEST: LDX #RTEST 
JMP TTYRO 
RTEST: DB $94,$80," GOT 4! SEND 4 MORE", SEE,$94,$84,"DONE”,$00,$00 


30 DB MANUAL GAIN REQUEST 


SETODB: BSET AGCFLG,$01 ;TURN OFF AGC 
LDAA #DBO00 ;SET 0 DB ATTENUATION 
STAA PORTA 
JMP PROMPT ;RETURN 


33 DB MANUAL GAIN REQUEST 


SETO3DB: BSET AGCFLG,$01 ;TURN OFF AGC 
LDAA #DBO03 ;SET 3 DB ATTENUATION 
STAA PORTA 
JMP PROMPT sRETURN 
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S88 SSS F8SE8SE8 8ST EE SSE €EF2EEE8 E848 €E SF S2S2 428 82S SE SSE S666 64665246 22S SESS aanan 


{9 DB MANUAL GAIN REQUEST 


SETO9DB: BSET 
LDAA 
STAA 
JMP 


AGCFLG,$01 
#DBO9 
PORTA 
PROMPT 


STURN OFF AGC 
SET 9 DB ATTENUATION 


SRETURN 


312 DB MANUAL GAIN REQUEST 


SET12DB: BSET 
LDAA 
STAA 


AGCFLG,$01 
#DB12 
PORTA 
PROMPT 


sTURN OFF AGC 
SET 12 DB ATTENUATION 


sRETURN 


3518 DB MANUAL GAIN REQUEST 


SET18DB: BSET 
LDAA 
STAA 


AGCFLG,$01 
#DB18 
PORTA 
PROMPT 


;TURN OFF AGC 
SET 18 DB ATTENUATION 


sRETURN 


524 DB MANUAL GAIN REQUEST 


SET24DB: BSET 
LDAA 
STAA 


AGCFLG,$01 
#DB24 
PORTA 
PROMPT 


sTURN OFF AGC 
SET 24 DB ATTENUATION 


;RETURN 


330 DB MANUAL GAIN REQUEST 


SET30DB: BSET 
LDAA 
STAA 


AGCON: CER 


AVODAT: DB 
Z JMP 


AGCFLG,$01 ;TURN OFF AGC 

#DB30 sSET 30 DB ATTENUATION 

PORTA 

PROMPT sRETURN 

AGCFLG SSET AGC ON FLAG TO 0 (TURN AGC ON) 
PROMPT sRETURN 

#AVODAT 

TTYO 

$81,PORTA,$00,$00 

PROMPT 


SESE KEKSKEEEEKREKERKEKEEKREKREREKREKEKEKREK ERE EREREEEREEEEREEREEE EE EE 
> 


wee LP FILE 

HELPFIL ‘FCB 
FCB 
FCB 
FEB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 


'elp SAIL DRIVER Mon, Jun 7, 1993, 11:53',$0D,$0A 
‘Monitor Commands (enter via _ or ? or !)',$O0D,$0A 

' _ (space) enter monitor*'’,$0D,$0A 

'?Maaaa_Illler *'$O0D,$0A 

'!Maaaa_dd...cr *'$0D,$0A 

‘Attenuator Commands (enter via A)',S50D,$0A 

' AO sets 0 dB manual attenuation',$0D,S0A 

' Al sets 3 dB manual attenuation’ $0D,50A 

' A2 sets 9 dB manual attenuation',$0D,$0A 

' A3 sets 12 dB manual attenuation’, $0D,$0A 
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FCB ' A4 sets 18 dB manual attenuation',$0D,$0A 
FCB ' AS sets 24 dB manual attenuation',$0D,$0A 
FCB ‘ A6 sets 30 dB manual attenuation',$0D,$0A 
FCB ' AA turns AGC on',$0D,$0A 

FCB _'O starts receiver collecting samples',$0D,$0A 
FCB _ 'P pauses receiver’, $0D,$0A 

FCB 'R resets the system',$OD,$0A 

FCB ‘with all RCA UT4 conventions’, $0D,$0A 
FCB  '* returns prompt',$00 


-FEKKEKEKEEEEEEEKEKEKREREKREKREKREREEEEEEEEEEEEEEEEEEEEEEEEEEE EES 
: 


ORG $FFD6 
VSCI: FDB_ SCI 
VSPI: FDB START 
VPAIE: FDB START 
VPAO: FDB START 
VTOF: FDB START 
VTOCS: FDB START 
VTOC4: FDB START 
VTOC3: FDB START 
VTOC2: FDB OC2 
VTOCI: FDB START 
VTIC3: FDB START 
VTIC2: FDB START 
VTIC1: FDB START 
VRTI: FDB START 
VIRQ: FDB START 
VXIRQ: FDB START 
VSWI: FDB START 
VILLOP: FDB START 
VCOP: FDB START 
VCLM: FDB START 
VRST: FDB START 

END 
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Appendix 3 

This appendix contains the C source code use by the Macintosh computer for 
the algorithm of figure 2-4. The user interface follows the guidelines specified by 
Apple, and the Event Manager is used to initiate all functions. After the hardware is 
initialized, the program waits in the EventLoop until an event is received. If no events 
are received in the loop cycle time, the program requests data from the 68HC11! and 
the GPS receiver. If the data is available, it is stored to form experiment vectors. 
Once enough experiment vectors are collected, the maximum likelihood estimate is 


calculated. The program the returns to the EventLoop. 


[ERE EE SER EEEEE TEESE ERE EEE TEREST ER EEE EE EE EEE EE EEE EE EEE EE EEEEEEEEEEEEEEEEE EEE 


TRACKER.C 


Dennis Michael Wojcik 
15 July 1993 


This program is version 1.0 of the Precision Tracking Receiver. It is tailored 
for the scenario of a stationary acoustic beacon and a moving observer. The 
program assumes that the observer has a GPS receiver for positioning data 
that can produce a fix at least every 2 seconds. If a different navigation 
system is used to provide ship locations, it is up to the user to provide 

the proper position format: 


2?L HHMMSS,DDMM.hh,N,DDDMM.hh,E,x,x,DOP,xxx,M,xxxxx,M 


EEE EERE EEE EERE EERE TEEEEEEERE EEE EE EEE EEE EEEEEE EEE EEEEEEEEE EEE EE / 


/PHSSHHEKEEEEKE KEE E EEE EEEEEE [NIC] UDES RHEE EERE EERE EERE EERE REEEEE EEE / 


#include <math.h> // needed for math calls 

#include <AppleEvents.h> // needed to handle AppleEvents 
#include <GestaltEqu.h> // needed to read system 7 AppleEvents 
#include <Values.h> // contains needed Mac constants 
#include <serial.h> // has needed serial comms constants 
#include <Packages.h> // needed to call time functions 
#include <string.h> // needed to call string functions 
#include <float.h> // contains needed constants 

#include <stdlib.h> // for standard calls such as strtoul etc 
#include <stdio.h> // usefull for debugging 


[RHEE EEEEEE EERE EEEEE EEE EE ER EER EERE ER EERE EE EEE HERE EEE EER EEE EERE EER EERE EEE EEE EE F/ 
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ee + SESS SSCS SSCS SS SESE SEES DEFINES SETHE SEERESSEE SEES GEESE EEEEEEEEEEEEEEEEEE/ 


#define kBaseResID 
#define kMoveToFront 
#define kUseDefaultProc 
#define kSleep 

#define kLeave Whereltls 


#define mApple 
#define iAbout 


#define mFile 
#define iQuit 


#define mAttenuator 
#define iAuto 
#define 10dB 

#define i3dB 
#define 19dB 

#define il2dB 
#define 118dB 
#define i24dB 
#define 130dB 


#define mBaud 
#define 1300 
#define 1600 
#define 11200 
#define 12400 
#define 14800 
#define 19600 


#define mSignal 

#define iPeriod 

#define 1NumMax 
#define 1Window 
#define 1MessageText 
#define kPeriodDialog 
#define kNumMaxDialog 
#define kWindowDialog 


#define kLeftMargin 
#define kFontSize 

#define kRowHeight 
#define kDataScanHeight 
#define kHorizontalOffset 
#define kGestaltMask 
#define kHorizontalPix 
#define kVerticalPix 
#define kMinWindowHeight 
#define kMinWindow Width 
#define kMinTextPosition 


128 
(WindowPtr)-IL 
(void *)-IL 
IL 
false 
kBaseResID 
l 
kBaseResID+1 
] 
kBaseResID+3 
] 
2 
3 
4 
5 
6 
Zi 
8 
kBaseResID+4 
] 
2 
3 
4 
5 
6 
kBaseResID+5 
] 

2 

3 
4 
kBaseResID 
kBaseResID+1 
kBaseRes]D+2 
4 
10 
(kFontSize+2) 
] 
0 
IL 
30 
40 
50 
80 
0 
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// define general resource infor 


// Apple menu resource ID 


// File menu resource ID 


// Attenuator menu resource ID 


// Baud Rate menu resource ID 


// Signal menu resource ID 


// define screen margins 





#define kMaxTextPosition 


#define kScrollbarAdjust 
#define kNormalUpdates 


#define bufferSize 
#define k16Bit 
#define k8Bit 
#define kHexBase 
#define kpi 


#define kNumExp 
#define kParameters 
#define kNumMeas 
#define kStep 
#define kC 

#define kMaxR 
#define kMaxD 
#define kMinD 


32767 


(16-1) 


true 


// define update constants 


1024 // misc. default values 
4 

2 

16 

3.141592654 


6 // default experiment parameters 
3 

6 

15 

1500 

5000.0 

-5000.0 

-1.0 


#define kxvar 
#define kyvar 
#define ktvar 


9.0 
9.0 
8.3333e-2 


[FREER EERE EEE EERE RE EEE EEE EEE EEE EEE EEE REE EERE REE EEE EE EEE EEE EEE EEE EEE EEE EEE EEE SE / 


[FERRER EERE EE ERE EEE EE EE EEE MACROS TEESE E TEESE SEE ETE EEE EEE EE ETE FES EEE ET TEST EE / 


#define TopLeft( r ) 
#define BottomRight( r ) 


(*(Point *) &(r).top) 
(*(Point *) &(r).bottom) 


ee © CCT EEEEAESAEE SESE CECE ERE CE SEE ESEESEEEE ESSE SESE EE EE SEES ESE ES EE EES EE / 


Poet SSE EC SESE ER EEE EEE EEE ERE GLOBALS EERE EEE EEE EE EEE EEE EE EEE EEE EEE EEE EEE / 


int gASerRefin, gASerRefOut; 
Boolean gDone, gHasPopupControl, gDataScan; 
Rect gTrackerRect; 
int gverticalPixels; 
int gRowStart, gDataRowStart, gserConfig; 
unsigned long gPeriod=2000UL; 
long gNumMax=2L, gWindow=20L; 
char gDataBuffer[bufferSize}; 
char gGPSBuffer[bufferSize]= 
"L 145642,0000.00,N,00000.00,E,0,0,000,000,M,0000,M"; 
short gLastAttn=1, gLastBaud=6; 
Str255 giltemText; 
unsigned long = ghorizontalPixels; 
WindowPtr gWetPaperWind, gTerminalWind, gRangeWind; 
long gPulseCounter=0L; 
long gCheckVal=1L; 


unsigned long 
double 
Boolean 


gtimel, gtime2; 
patel, Zyrel, gx, gX2, eYl, 2Y2; 
gstarter=true, 
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Boolean 
Boolean 
double 
unsigned long 
double 

double 

double 


double 
int 

int 
long 
double 
char 
char 


greflag=true; 

gDataWrap=false, trackerStart=false; 

gYFact; 

gt_mul, gt mu2; 
gV[kNumMeas]={kxvar,kyvar,ktvar,kxvar,ky var,ktvar}; 
gtheta[3J={ 0.0, 0.0, -2000.0}, gPosition[kParameters]; 
*ow; 


gxold=0.0, gyold=0.0; 
gnumIts=0; 

gmu=0; 
gi=OL,gnumExp=0L; 
gj=1.0; 
gYrefString[8]; 
gXrefString[9]; 


PEST SERSEES SESE EE RER EEE EEE EE ESSERE EEE EKER ERESE EERE EE EREEEEEE EERE RE EEE ESS / 


eS SSeS EEE EEE EE ET SES FUNCTION PROTOTY PES=2 tt te Steer eee eee eee rere eer ers s/ 


void 

void 

void 

void 

void 

void 
unsigned long 
void 

void 

void 

void 

void 

void 

void 

void 
unsigned long 
void 

void 

int 

void 

void 

void 
unsigned 

int 

void 

int 

int 

void 
unsigned long 
double 
double 

void 

pascal OSErr 


ToolBoxInit(void); 

Windowlnit(void); 

MenuBarlnit(void); 

SerialInit(void); 

EventLoop(void); 

DoEvent( EventRecord *eventPtr ); 
HandleDataIn(int numDataPoins); 
HandleMouseDown(EventRecord *eventPtr); 
HandleMouseUp(EventRecord *eventPtr); 
HandleMenuChoice( long menuChoice ); 
HandleAppleChoice( short item ); 
HandleFileChoice( short item ); 
HandleAttenuator(short item); 
HandleBaud(short item); 
HandleSignal(short item); 
HandleDialog(int dialogRes); 
ConcatString(Str255 strl, Str255 str2); 
HandleKeyIn( char theChar); 

TalkSail( char theChar); 

Display String(int numDataPoints); 
ScrollDisplay(void); 

HandleNull( void ); 

HexCharTolInt(char Bite,int exponent); 
DecIntToHexChar(int decimal); 
DoUpdate(EventRecord *eventPtr); 
Power(int base, int exponent); 
DecIntToHexChar(int decimal); 
ScrollDataScan(void); 
DecTimeToSec(unsigned long timeVal); 
LatTo Y(double latVal),; 

LongToX(double longVal, double cosfact); 
tracker(long numExp); 
SetDialogDefaultItem(DialogPtr theDialog, short newItem) 
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={ 0x303C, 0x0304, OxAA68}; 

pascal OSErr SetDialogCancelltem(DialogPtr theDialog, short newlItem) 
={0x303C, 0x0305, OxAA68}; 

pascal OSErr SetDialogTracksCursor(DialogPtr theDialog, Boolean tracks) 
={0x303C, 0x0306, 0xAA68}; 


[PPE EHEERE EEE EERE ERE EERE EERE EERE EEE EE EEE EEE EEE REE EEE EERE TEER ER ENE EEE EEE EEE HE / 


[* ---------------------------- Malin--------------------22222-------------- +/ 
void main(void) 
{ 
WindowPtr window; 
OSErr RAMOpenEnr, resetErrIn, resetErrOut, bufSizeEr, 
int SerConfig; 
Ptr serBPtr; 
char serInBuffer[bufferSize]; 
long numCharIn, numCharOut, maxtime; 
char addressBuf[20]; 
ToolBoxInitQ; // initialize the toolboxes 
WindowInitQ); // set up the windows 
MenuBarInitQ; // draw the menu bar 
SerialInitQ; // open the serial drivers 
window=Front Window(); // ensure we're in the window 
RAMOpenErr=RAMSDOpen(sPortA); // open the RAM Serial Drivers 
if (RAMOpenEr != noErr) // if we can't open RAM Driver beep 
{ 
SysBeep(10); 
ScrollDisplayQ; 


DrawString("\pProblem opening the RAM Serial Drivers."); 
} 
gserConfig=baud9600+data8+stop 10+noParity; // Set the protocal for 9600 
// 8 data, | stop, no parity 
resetErrmn=SerReset(gASerRefIn,gserConfig); 
resetErrOut=SerReset(gA SerRefOut,gserConfig); 
if (resetErmn != noEr) || (resetErrOut != noEr)) 


{ 
SysBeep(10); // if we can't set the protocal 
ScrollDisplayQ; // beep 
DrawString("\pProblem setting the serial protocal."); 
} 
serBPtr=serInBuffer; // Set the serial buffer size 


bufSizeErr=SerSetBuf(gA SerRefin,serBPtr,bufferSize); 
if (bufSizeErr != noErr) 


{ 
SysBeep(10); // if we can't set the buffer 
ScrollDisplayQ; // size, beep 
DrawString("\pProblem resizing the serial input buffer."); 
} 
ScrollDisplayQ; 
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numCharOut=5L; // see if we can talk to the GPS receiver 
FSWrite(gASerRefOut, &numCharOut, "4GPS "); 

SerGetBuf(gA SerRefiIn,&numCharIn); 

maxtime=TickCount()+20L; 

while(numCharIn < 9L) 


{ 
SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountQ) > maxtime) 
{ 
SysBeep(10); 
DrawString("\p Can't talk to the GPS reciever, unable to run!!"); 
ScrollDisplay (0; 
break; 
} 
} 


FSRead(gASerRefIn,&numCharIn,&addressBuf); 


numCharOut=5L; // see 1f we can talk to the PTR receiver 
FS Write(gASerRefOut, &numCharOut, "#PTR "); 

SerGetBuf(gASerRefIn,&numCharIn), 

maxtime=TickCount()+20L; 

while(numCharIn < 9L) 


{ 
SerGetBuf(gA SerRefiIn,&numCharlIn); 
if(TickCountQ > maxtime) 
{ 
SysBeep(10); 
DrawString("\p Can't talk to the PTR reciever, unable to run!!"); 
ScrollDisplayQ; 
maxtime=TickCount()+120L; 
while(TickCountQ) < maxtime) 
TickCount(); 
abort(; 
} 
} 
F SRead(gASerRefin,&numCharIn,&addressBuf); 
TalkSail(‘O'); // start the PTR's data collection 
DrawString("\p: "); // display a cursor 
gw = calloc(3L*kStep*(kNumExp+tl),sizeof(double)); // get memory for data 
if (gw == NULL) 
{ 
DrawString("\pCan't allocate memory for data collection!!!"); 
abortQ(); 
} 
EventLoop(Q); // main execution loop 
RAMSDClose(sPortA), // must close the RAM Drivers before shutdown 
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free(gw); // must release the memory before shutdown 


ToolBoxInit(void) 
// initialize all of the ToolBox 
InitGraf(&thePort), // Routines 
InitFontsQ; 
Init Windows(Q; 
InitMenus(); 
TEImitQ; 
InitDialogs(nil); 
InitCursor(; 


Windowlnit(void) 
// initialize the display windows 
WindowPtr window; 
short fontNum; 
Boolean update = true; 


window = GetNewWindow(kBaseResID, nil, kMoveToFront); 


if (window == nil) 


{ 
SysBeep(10); // Couldn't load the WIND resource 
ExitToShellO; 

} 

SetPort(window); // set the window to be active 

GetFNum("\pTimes", &fontNum), // use Times font 

if (fontNum != 0) TextFont(fontNum), 

TextSize(kFontSize); // use the default font size 


gverticalPixels=screenBits.bounds.bottom-screenBits.bounds.top-45; 
ghorizontalPixels=screenBits.bounds.right-screenBits.bounds. left-10; 
gDataRowStart=gverticalPixels-2*kFontSize; 


Size Window(window, ghorizontalPixels, gverticalPixels, update); 


Show Window(window); // activate the window 
g WetPaperWind=FrontWindow(Q; 


gTerminalWind = GetNewWindow(kBaseResID+1, nil, kKMoveToFront); 
if (gTerminal Wind == nil) 
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SysBeep(10); // Couldn't load the WIND resource 
ExitToShell(); 
} 
SetPort(gTerminal Wind); // set the window to be active 
GetFNum("\pTimes", &fontNum); // use Times font 
if (fontNum != 0) TextFont(fontNum); 
TextSize(kFontSize); // use the default font size 


gRowStart=gTerminal Wind->portRect.bottom-2*kFontSize; 


Show Window(gTerminal Wind); 


We OE */ 
a----------------- MenuBarInit------------------------------------*/ 
MenuBarInit(void) 
Handle menuBar; 
MenuHandle menu; 
menuBar = GetNewMBar( kBaseResID ); 
SetMenuBar( menuBar ); 
menu = GetMHandle( mApple ); 
AddResMenu( menu, 'DRVR’); 
DrawMenuBar(Q); 
oneness a */ 
eeennnnnnn nnn enn nee Serial Init------------------------------------*/ 
SerialInit(void) 
WindowPtr window, 
OSErr openErr, RAMEr, resetErr ; // define system errors 
int serConfig; // define the port configuration 
char driverStringIn[{]J="\p.AIn"; // define the input driver name 
char driverStringout[]="\p.Aout"; // define the output driver name 


window=Front Window(); 


openErr=OpenDriver(driverStringIn,&gASerRefin); // Open the port A ROM input serial driver 
if (openErr != 0) 
{ 
SysBeep(10); 
ScrollDisplayQ; 
DrawString("\pCan't open the ROM Serial input driver"); 
returm; 
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} 


openErr=OpenDniver(driverStringout,& gASerRefOut); // Open the port A ROM output 
//serial driver 
if (openErr != 0) 


{ 
SysBeep(10); 
ScrollDisplayQ); 
DrawString("\pCan't open the ROM Serial output driver"); 
return; 
} 


gserConfig=baud9600+data8+stop10+noParity; // Set the protocal for 
// 9600, 7D, 1S, no parity 


resetErr=SerReset(gASerRefIn,gserC onfig); // Set the input driver to the new protocal 
if (resetErr != 0) 
{ 
SysBeep(10); 
ScrollDisplayQ; 
DrawString("\pCan't set the ROM Serial input protocal"); 
return; 
} 
resetErr=SerReset(gASerRefOut,gserC onfig); // Set the output driver to the new protocal 
if (resetErr != 0) 
{ 
SysBeep(10); 
ScrollDisplay(); 
DrawString("\pCan't set the ROM Serial output driver"); 
return; 
} 
| eee = a a a i ee */ 
wor eennnnnn-------- EventL 00p--------------ennnn nnn nnn nnn nnene-n n= #/ 
EventLoop(void) 
EventRecord event; 


gDone = false; 


while (gDone == false) // loop here until done with program 
{ 
if (WaitNextEvent(everyEvent, &event, kSleep, nil)) 
DoEvent(&event); 
else 
HandleNullQ; // collect data here 


void DoEvent(EventRecord *eventPtr) 


{ 
Boolean becomingActive; 
char theChar; 
switch (eventPtr->what) 
{ 
case mouseDown: 
HandleMouseDown(eventPtr); 
break; 
case mouseUp: 
HandleMouseUp(eventPtr); 
break; 
case keyDown: 
theChar = eventPtr->message & charCodeMask; 
if((eventPtr->modifiers & cmdKey) != 0) 
HandleMenuChoice(MenukKey( theChar)); 
else 
HandleKeyIn( theChar ); 
break; 
case updateEvt: 
DoUpdate( eventPtr); 
break; 
ibe case activateEvt: 
becomingActive = ((eventPtr->modifiers & 
activeFlag) == 
activeF lag); 
DoActivate((WindowPtr)eventPtr->message, 
becomingActive); 
break;*/ 
} 
} 
Ere fee 8 ee POO Sie on ees */ 
|* ---------------------- HandleNull--------------------------------------- ag 
void HandleNull(void) 
{ 
int numGPSPoints; 
int numDataPoints; 
int GPSbuff, 
long numCharOut, numCharIn, numCharInOld,; 
char addressBuf] bufferSize]; 
char *tok; 
char *timeOfRx, 
char * latitude; 
char * longitude; 
char *HDOP,; 
char *delim=" ,"; 
char *end, 


lo? 





int 

unsigned long int 
double 
double 
unsigned long 
long 

Str255 

char 

double 

long 

double 


if (gDataScan == true) 


{ 


1, 

timeVal;, 

lat Val,longVal,HDOPVal; 
cosfact; 

Lamu; 

maxtime; 

numstr; 
*lattest="1234.89"; 
lattestd, dl; 
lattestdec,lattestr; 
timemod; 


/*---> use this part when the GPS receiver is available 


| 


numCharOut=5L; 
FSWrite(gASerRefOut, &numCharOut, "#GPS "); 
SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCount()+20L; 
while(numCharIn < 9L) 
{ 
SerGetBuf(gASerRefln,&numCharIn); 
if(TickCount(Q) > maxtime) break; 


} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 


numCharOut=2L,; 
FSWrite(gASerRefOut, &numCharOut, "?L"); 
SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCountQ+20L; 
while(numCharIn < 55L) 
{ 
SerGetBuf(gASerRefIn,&numCharIn),; 
if(TickCountQ) > maxtime) break; 
} 
FSRead(gASerRefIn,&numCharIn,&gGPSBuffer); 


numCharOut=5L; 
FS Write(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCountQ+20L; 
while(numCharIn < 9L) 
{ 
SerGetBuf(gASerRefiln,&numCharIn),; 
if(TickCountQ) > maxtime) break; 
} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 


numDataPoints=TalkSail(’-'); 
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if(numDataPoints > 5) 


{ 


gPulseCountert+; 


tok=strtok(gGPSBuffer,delim), 
timeOfRx=strtok(NULL,delim); 
latitude=strtok(NULL,delim); 
tok=strtok(NULL, delim); 
longitude=strtok(NULL, delim); 
tok=strtok(NULL, delim); 
tok=strtok(NULL, delim); 
tok=strtok(NULL, delim), 
HDOP=strtok(NULL, delim); 


time Val=strtoul(timeOfRx,&end,10); 
latVal=strtod(latitude,&end); 

long Val=strtod(longitude,&end); 
HDOPVal=strtod(HDOP,&end); 


if (HDOPVal < 10.0) 


{ 
if (gstarter == true) 
{ 
t_mu=HandleDataIn(numDataPoints); 
gtime2=DecTimeToSec(time Val); 
gX2=0.0; 
gY2=0.0; 
if (greflag == true) 
{ 
g Yref=LatTo Y(latVal); 
g YFact=cos((g Yref/(1853.2*60.0))*kpi/180.0); 
gXref=LongToX(long Val,g YFact); 
greflag=false; 
} 
gstarter=false; 
} 
else 
{ 


t_mu=HandleDataIn(numDataPoints); 
/*---> use this if GPS availble to see if fixes are 2 sec apart 


if(DecTimeToSec(timeVal) != gtime2-2UL) 
zy 
if(DecTimeToSec(timeVal) != gtime2) 


{ 


gstarter=true; 


} 


else 


{ 
gtime!=gtime2; 
gtime2=DecTimeToSec(timeVal); 
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//---> make up data to test program 


//---> end of simulated data 


/*--->use this if GPS available 


*/ 


else 


gXl=gX2; 
gX2=LongToX(longVal,gYFact)-g Xref; 
gYl=gY2; 

gY2=LatTo Y(latVal)-gYref; 


gw([gi]J=gxold+cos(0.00515*gj)*5.14778; 
gw[ git] ]=gyold+sin(0.00515*gj)*5.14778, 


gxold=gw/[gil; 

gyold=gw/[git1]; 

gj=gj+1.0; 

dl=sqrt((gxold-1000)*(gxold-1000) 
+(gyold-2000)*(gyold-2000)+3000* 3000); 

timemod=d1/1.5; 

while(timemod > 2000.0) 
timemod=timemod-2000.0; 

gw[git+2]=timemod; 


gw[gij=(1.0-t_mu/((gtime2-gtime1)* 1000.0)*gX 1 
+2X2; 

gw[gitl]=(1.0-t_mu/((gtime2-gtime1)*1000.0)*gY1 
+o Y2. 

gw[git2]=t_mu; 


gi=git3L; 
if(gi >= 3L*(kStep*kNumExp+IL) ) 
trackerStart=true; 
if(gi >= 3L*kStep*(kNumExp+1L) ) 
{ 
gi=0L; 
gDataWrap=true; 
} 


if((trackerStart == true) || (gDataWrap == true)) 
{ 


tracker(gnumExp); 


t_mu=HandleDataIn(numDataPoints); 
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gsta rier=true; 


} 
} 
} 
} 
fe enol le ne ae */ 
/* ------------------------ DecTimeToSec----------------------------------- */ 


unsigned long DecTimeToSec(unsigned long time Val) 


{ 


unsigned long hr, min, sec, timeSec; 
hr=time Val/10000UL, 

min=(time Val-hr* 1|OOOOUL)/100UL; 
sec=time Val-hr* 1|OOOOUL-min* 1OOUL; 


timeSec=hr*3600UL+min*60UL+tsec; 


return(timeSec); 
} 
ces SE */ 
[* ------------------------ Long l0X---------------------------------------- */ 
double LongToX( double longVal, double cosfactor) 
{ 
long double deg, min, X; 
deg=floor(longVal/100.0); 
min=(longVal-deg* 100.0); 
X=(deg*60.0+min)* 1853.2*cosfactor; 
return(X); 
} 
eee */ 
[* ------------------------ LatTo Y ----------------------------------------- a 
double LatTo Y(double latVal) 
{ 


long double deg, min, Y; 


deg=floor(lat Val/100.0); 
min=(lat Val-deg* 100.0); 


Y=(deg*60.0+min)* 1853.2; 
return(Y); 
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Ia eo week +/ 
[* ~---------------------- HandleMouseDown--------------------------------- | 
void HandleMouseDown(EventRecord *eventPtr) 
{ 
WindowPtr whichWindow,; 
GrafPtr oldPort; 
short thePart; 
long menuChoice; 


thePart = FindWindow(eventPtr->where, &whichWindow), 


switch(thePart) 
{ 
case inMenuBar: 
menuChoice = MenuSelect( eventPtr->where ); 
HandleMenuChoice( menuChoice ); 
break; 
case inSysWindow: 
SystemClick(eventPtr, whichWindow); 
break; 
case inContent: 
SetPort(which Window); 
GlobalToLocal( &eventPtr->where); 
break; 
case inDrag: 
Drag Window(whichWindow, eventPtr->where, 
&screenBits.bounds); 
break; 
case inGoAway: 
gDone = true; 


break; 

} 
} 
ee + / 
[* ------------------------ HandleMouseUp---------------------------------- fs 
void HandleMouseUp(EventRecord *eventPtr) 
{ 

// Put some function in here 
} 
SONNE Te fone ore 0 A es oe cee ees uowiweudabees */ 
[* ~------------------- HandleMenuChoice----------------------------------- */ 
void HandleMenuChoice(long menuChoice) 
{ 


short menu; 
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short 


item; 


if (menuChoice != 0) 


{ 


menu=Hi Word(menuChoice),; 
item=Lo Word(menuChoice); 


switch(menu) 


{ 


} 


case mApple: 
HandleAppleChoice(item), 
break; 

case mFile: 
HandleFileChoice(item),; 
break; 

case mAttenuator: 
HandleAttenuator(item); 
break; 

case mBaud: 
HandleBaud(item); 
break; 

case mSignal: 
HandleSignal(item); 
break; 


HiliteMenu(0), 


HandleAppleChoice( short item ) 


MenuHandle 
Str255 
short 


switch(item) 


{ 


appleMenu; 
accName; 
accNumber; 


case iAbout: 


default: 


NoteAlert(kBaseResID,nil); 
break; 


appleMenu = GetMHandle(mApple); 
GetItem(appleMenu, item,accName); 
accNumber=OpenDeskAcc(accName); 
break; 





HandleFileChoice(short item) 


switch(item) 
{ 
case 1Quit: 
gDone = true; 
break; 
} 
PUNO lo Sus cece Suet sss gene cede cl accskudctwasnconckond */ 
wn en n----+ = 22-22 --- HandleAttenuator-----------------------------*/ 


HandleAttenuator(short item) 


MenuHandle menuHandle; 
long numCharOut, numCharIn; 
char attenBuff] 10], addressBuf] 10]; 


numCharOut=5L,; 

FSWrite(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 


{ 
SerGetBuf(gASerRefIn,&numCharIn); 


} 
FSRead(gASerRefIn,&numCharIn,&addressBuf), 


numCharOut=2L; 
numCharIn=6L; 
menuHandle=GetMHandle(mAttenuator), 


CheckItem(menuHandle,gLastAttn,false); 
CheckItem(menuHandle,item,true); 
gLastAttn=item; 


switch(item) 
{ 
case 1Auto: 
FSWrite(gASerRefOut, &numCharOut, "AA"); 
break; 
case 10dB: 
FSWrite(gA SerRefOut, &numCharOut, "A0"); 
break; 
case 13dB: 
FSWrite(gASerRefOut, &numCharOut, "A1"); 
break; 
case 19dB: 
FSWrite(gASerRefOut, &numCharOut, "A2"); 
break; 
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case 112dB: 
FSWrite(gASerRefOut, &numCharOut, "A3"); 


break; 
case 118dB: 
FSWrite(gASerRefOut, &numCharOut, "A4"), 
break; 
case 124dB: 
FS Write(gASerRefOut, &numCharOut, "A5"); 
break; 
case 130dB: 
FSWrite(gASerRefOut, &numCharOut, "A6"); 
break; 
} 
FSRead(gASerRefIn, &numCharlIn, attenBuff), 
ee ea eae ene ee ee */ 
n------------------- HandleBaud-----------------------------------*/ 
HandleBaud(short item) 
MenuHandle menuHandle; 
long numCharOut, numCharOutr, numCharIn; 
int serConfig; 
OSErr resetErrIn, resetErrOut; 
char inBuff[8]; 
SerStaRec serial StatusOut; 


numCharOut=8L; 
menuHandle=GetMHandle(mBaud), 


CheckItem(menuHandle,gLastBaud,false); 
CheckItem(menuHandle,item,true); 
gLastBaud=item; 


switch(item) 
{ 
case 1300: 
FSWrite(gASerRefOut, &numCharOut, "#0000300"); 
gserConfig=baud300+data8+stop 10+noParity; 
break; 
case 1600: 
FS Write(gASerRefOut, &numCharOut, "#0000600"); 
gserConfig=baud600+data8+stop10+noParity; 
break; 
case 11200: 
FSWrite(gASerRefOut, &numCharOut, "#0001200"); 
gserConfig=baud 1 200+data8+stop10+noParity; 
break; 
case 12400: 
FSWrite(gASerRefOut, &numCharOut, "#0002400"); 
gserConfig=baud2400+data8+stop10+noParity; 
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break; 

case 14800: 
FS Write(gASerRefOut, &numCharOut, "#0004800"); 
gserConfig=baud4800+data8+stop10+noPanity; 
break; 

case 19600: 
FS Write(gASerRefOut, &numCharOut, "#0009600"); 
gserConfig=baud9600+data8+stop 10+noPanity; 
break; 


} 


SerStatus(gASerRefOut,&serialStatusOut),; 
while ((serialStatusOut.rdPend != 0) || (serialStatusOut.wrPend !=0)) 


{ 
SerStatus(gASerRefOut,&serialStatusOut); 
} 


FSRead(gASerRefIn, &numCharOut, &inBuff); 


resetErrOut=SerReset(gASerRefOut,gserConfig); 


resetErm|n=SerReset(gASerRefIn,gserConfig); // Set the protocal 
if ((resetErrIn != noErr) || (resetErrOut != noErr)) 
{ 
SysBeep(10); 
ScrollDisplay Q; 
DrawString("\pProblem setting the serial protocal."); 
} 
2 if a gee */ 
ao-------2-------- HandleSignal-----------------------------------*/ 
HandleSignal(short item) 
Str255 periodData="\p!M52 "; 
Str255 numMaxData="\p!M63 "; 
Str255 windowData="\p!M74 "; 
char hexChar; 
long numCharOut, numCharIn; 
char inbuff[30], outbuff[20], addressBuf] 10]; 
int er[ 1] ={13}; 
int radix, hexDec; 
short 1; 
int period, numMax, window; 
SerStaRec serialStatusOut; 


numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 


{ 
SerGetBuf(gASerRefIn,&numCharIn); 
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} 
FSRead(gASerRefin,&numCharIn,&addressBuf); 


switch(item) 
{ 
case iPeriod: 
gPeriod=HandleDialog(kPeriodDialog), 
period=gPeriod; 
for @=0;1 < k16Bit; i++) 


{ 
radix=Power(kHexBase,k 16Bit-1-1); 
hexDec=period/radix; 
hexChar=DecIntToHexChar(hexDec), 
periodData[ 1] +1+periodData[0]]=hexChar, 
period=period-hexDec* radix; 

} 


periodData[periodData[0]+k 1 6Bit+1 ]=cr[0]; 
periodData[0]=periodData[0]+k16Bit+1; 


for ((=0;1<periodData[0];1++) 


{ 
outbuff[1]=periodData[i+1]; 
} 
numCharOut=periodData[0}]; 
break; 


case iNumMax: 
gNumMax=HandleDialog(kNumMaxDialog); 
numMax=gNumMax*2; 
for (i=0;1 < k8Bit; i++) 


{ 
radix=Power(kHexBase,k8Bit-1-1); 
hexDec=numMax/radix; 
hexChar=DecIntToHexChar(hexDec),; 
numMaxData[ | +i+numMaxData[0]]=hexChar; 
numMax=numMax-hexDec* radix; 

} 


numMaxData[numMaxData[0]+k8Bit+]1 ]=cr[0]; 
numMaxData[0]=numMaxData[0]+k8Bit+1; 


for (i=0;i<numMaxData[0];i++) 


{ 
outbuff[i]=numMaxData[it+1]; 
} 
numCharOut=numMaxData[0]; 
break; 


case 1Window: 
g Window=HandleDialog(kWindowDialog),; 
window=g Window; 
for (i=0;i < k16Bit; i++) 
{ 
radix=Power(kHexBase,k 1 6Bit- 1-1); 
hexDec=window/radix; 
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hexChar=DecIntToHexChar(hexDec); 
windowData[ 1+1+numMaxData[0]]=hexChar; 
window=window-hexDec* radix; 

} 

windowData[windowData[0]+k 16Bit+] ]=cr[0]; 

windowData[0]=windowData[0]+k 16Bit+1; 


for (1=0;i<windowData[0];i++) 


{ 
outbuff[1]=windowData[i+1]; 
} 
numCharOut=windowData[0]; 
break; 
} 
FS Write(gASerRefOut,&numCharOut,&outbuff); 
while(1 == 1) 
{ 


SerGetBuf(gASerRefIn,&numCharIn); 
FSRead(gASerRefin, &numCharIn, &inbuff); 


if(inbuff[numCharIn-1L] == 03) break; 


} 
see +/ 
-------------- DecIntToHexChar------------------------------------*/ 
DecIntToHexChar(int decimal) 
int hexChar; 
if ((decimal >= 0) & (decimal < 10)) 
hexChar=48+decimal; 
if ((decimal >= 10) & (decimal < 16)) 
hexChar=55+decimal; 
return(hexChar); 
so eS * / 
w------------- ConcatString---------------------------------------*/ 


ConcatString(Str255 strl, Str255 str2) 
short 1; 

for(i=str1[{0];i<str2[0]+str 1[0];i++) 

{ 


str] [1+1]=str2[1-str1[0]+1]; 
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} 


str1[{0]=1; 

} 

OO ow */ 

[* --------------------- HandleDialog-------------------------------------- */ 

unsigned long HandleDialog(int dialogRes) 

{ 

WindowPtr window; 
DialogPtr dialog; 

Boolean dialogDone; 
Handle textItemHandle; 
Handle okItemHandle; 
short itemType, itemHit; 
Rect itemRect; 

long itemNum; 
unsigned long  itemNumU; 
window=FrontWindow(); 
dialog=GetNewDialog(dialogRes,nil,kMoveToFront), 
Show Window(dialog); 
SetPort(dialog); 

/* SetDialogDefaultItem(dialog, ok); 
SetDialogCancelltem(dialog, cancel), 
SetDialogTracksCursor(dialog, true); 

a 


GetDitem(dialog, iMessageText, &itemType, 

&textItemHandle, &itemRect); 
GetDItem(dialog, ok, &itemType, &okItemHandle, 

&itemRect); 
SellText(dialog, iMessageText, kMinTextPosition, kMaxTextPosition); 


dialogDone=false; 
while( ! dialogDone) 


{ 
GetIText(textItemHandle, &gltemText); 
ModalDialog(nil, &itemHit); 
switch(itemHit) 
{ 
case ok: 
case cancel: 
dialogDone=true; 
break; 
} 
} 


DisposeDialog(dialog); 
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SelectWindow(window); 
SetPort(window), 


StringToNum(gltemText, &itemNum),; 
itemNumU=itemNum; 


return(itemNumU); 
Ene Soeecans scccbecceasease sacecoosssnssscscesescneseoeeessace -7 
wonnnnnn nnn ---- HandleKeyIn---------------------------------------*/ 

HandleKeyIn(char theChar) 

int bufferLength, 1; 

RgnHandle gtempRegn, 

long numCharOut, numCharIn; 

char addressBuf] 10]; 


gtempRgn = NewRgnQ; 


switch(theChar) 
{ 
case 'W': 
gDataScan=false; 
Select Window(gTerminal Wind); 
SetPort(gTerminal Wind); 
DrawString("\pW"); 
ScrollDisplayQ; 
DrawsString("\p:"); 
break; 
case: K- 
gDataScan=false; 
SelectWindow(gTerminal Wind); 
SetPort(gTerminal Wind); 
numCharOut=5L,; 
FSWrite(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 


{ 
SerGetBuf(gASerRefIn,&numCharIn); 


} 
FSRead(gASerRefIn,&numChar!In,&addressBuf); 


bufferLength=TalkSail(‘P’); 
Display String(bufferLength), 
gi=0L; 
break; 

case '-': 
gDataScan=true; 
Select Window(gWetPaper Wind), 
SetPort(gWetPaper Wind); 
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default: 


unsigned long 


{ 


int 

char 
unsigned 
unsigned long 
Str255 
unsigned long 
float 

Str255 


for (i=0;1 < 10;1++) 
{ 
ScrollDataScanQ); 
} 
numCharOut=5L,; 
FS Write(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefin,&numCharIn), 
while(numCharIn < 91) 


{ 
SerGetBuf(gA SerRefIn,&numC harIn), 


} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 


bufferLength=TalkSail(‘O’), 
bufferLength=TalkSail(theChar); 
break; 


Select Window(gTerminal Wind); 
SetPort(gTerminal Wind), 
bufferLength=TalkSail(theChar), 
Display String(bufferLength); 
break; 


HandleDataIn(int numDataPoints) 


rea 

max[8][4], time[8][4]; 

timeInt[8], maxInt[8]; 

timeLong; 

timeOfMaxString; 

drawTime, dtemp, horizonta]Posit; 
fraction; 

numpixel,horstring; 


for G=0;)<gNumMax;j++) 


for (1=0;1<4;1++) 


{ 


} 


max[j][i]=gDataBuffer[8*)+4-1]; 
time[}][i]=gDataBuffer[8*j+8-1]; 


timeInt[j]=0; 
maxInt[j]=0; 
for(i=0;1<451++) 


{ 
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time! nt{j]=timeInt{)]+HexCharToInt(time[j][1],1); 
max Int{j]=maxInt[{j]+HexCharToInt(max{j][1],1); 


} 

} 

for (=0;1 < gNumMax; i++) 

{ 
drawTime=(timelnt(1]*(ghorizontalPixels-8UL))/gPeriod; 
SetPort(gWetPaper Wind); 
horizontalPosit=drawTime tkLeftMargin; 
PenNormal(); 
MoveTo(horizontalPosit,gDataRowStart); 
Line(0,0); 

} 

ScrollDataScanQ; 


timeLong=timelInt(0]; 


return(timeLong); 
} 
SI ee se SE os co cosccecccencenasn<sadscacces */ 
[* -------------------- HexCharTolInt--------------------------------------- oh 
unsigned HexCharTolInt(char Bite,int exponent) 
{ 
unsigned value; 
if ((Bite > 47) & (Bite < 58)) 
value=(Bite-48)* Power(kHexBase,exponent); 
if ((Bite > 64) & (Bite < 71)) 
value=(Bite-55)* Power(kHexBase,exponent); 
return(value); 
} 
yy ee */ 
[* ------------------- TalkSail-------------------------------------++---+-- aj 
int TalkSail(char theChar) 
{ 
long numCharOut, numCharIn, startTime,maxTime; 
OSErr serOutEr, serInEr; 
char inBuff[bufferSize],DataBuffer[bufferSize],inChar; 
int 1, start; 
SerStaRec serialStatusIn, serialStatusOut; 
Str255 startString; 


numCharOut=1L; 
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serOutErr=FS Write(gASerRefOut, &numCharOut, &theChar); 
if (serOutErr != noErr) 


{ 
SysBeep(10); 
DrawString("\pProblem sending the character out."); 
ScrollDisplayQ; 
DrawString("\p:"); 
} 


SerStatus(gASerRefOut,&serialStatusOut); 
while ((serialStatusOut.rdPend != 0) |] (serialStatusOut.wrPend !=0)) 


{ 
SerStatus(gASerRefOut,&serialStatusOut); 


} 


SerStatus(gASerReflIn,&serialStatusIn); 
while(serialStatusIn.rdPend != 0) 
SerStatus(gASerRefIn,&serialStatusIn); 


start=0, 

startTime=TickCountQ; 

maxTime=startTimet+20L; 

while(] == 1) 

{ 
SerGetBuf(gASerRefIn,&numCharIn); 
serInErr=FSRead(gASerRefln, &numCharIn, &inBuff); 

if (serInErr != noErr) 


{ 
SysBeep(10); 
DrawString("\pProblem receiving characters."); 
ScrollDisplay(); 
DrawString("\p:"); 
} 


memmove(&gDataBuffer[start],&inBuff,numCharIn); 
start=start+tLoWord(numCharIn); 


ifG@nBuff[numCharIn-1L] == 03) break; 
if((start < 2) & (TickCount() > maxTime)) break; 


} 
return(start); 
aoa nseec ec ES ee */ 
--------------- Display String-------------------------------------*/ 
Display String(int numDataPoints) 
int i 


for (i=0;1 < numDataPoints ;1++) 


{ 


213 





switch(gDataBuffer[1]}) 


{ 
case 03: 
break; 
case 13: 
{ 
if (gDataBuffer[i+1] == 10) 
{ 
ScrollDisplayQ; 
1=1+1; 
} 
break; 
} 
case 10: 
{ 
if (gDataBuffer[i+1] == 13) 
{ 
ScrollDisplayQ; 
i=i+]; 
} 
break; 
} 
default: 
DrawChar(gDataBuffer[1]); 
} 
} 
cree Se ee ee +/ 
ann nen--e-- 2 ee == ScrollDisplay ------------------------------------*/ 
ScrollDisplay(void) 


RgnHandle tempRgn; 
WindowPtr window; 


window = FrontWindow(); 
tempRgn = NewRgnQ; 


ScrollRect(&window->portRect, kHorizontalOffset, 
-kRowHeight, tempRgn); 
DisposeRgn(tempRgn); 


MoveTo(kLeftMargin, gRowStart); 


ScrollDataScan(void) 


RgnHandle tempRegn; 
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WindowPtr window; 

window = FrontWindow(Q; 

tempRgn = NewRegn(Q); 

ScrollRect(&window->portRect, kHorizontalOffset, 
-kDataScanHeight, tempRgn), 

DisposeRgn(tempRgn); 


MoveTo(kLeftMargin, gDataRowStart); 


en eNNMN Mee Wall 2 aN In Dee peter Pa fod a Mere cisco */ 
ooo renee nnn enn == DoUpdate--------------------------------------*/ 
DoUpdate(EventRecord *eventPtr) 
WindowPtr window; 
window = (WindowPtr)eventPtr->message; 
BeginUpdate(window), 
// put some update info in here 
EndUpdate(window); 
eens eee rme ne ters Obie Ter adee eat i Leones oe esas acecce */ 
wo nen anon eee eee POWEI---------2-- 22-222 nnn n nee eo nn nn enn ee----- == F/ 
Power(int base, int exponent) 
int ls fae 
p=; 
for (i=1;1 <= exponent;++1) 
p=p* base; 
return(p); 
eee REE 5 oe */ 
tracker(long numExp) 
int Hale 
int nextIteration, noUpdate=0, numlIterations=0; 
long u, index 1, index2; 
double f, Cs=1.5; 
double theta[kParameters]={0.0,1000.0,-2500}; 
double xvar, yvar, tvar, V[kNumMeas]; 
double term; 
double stopval=1.0, epsilon=0.1, epsilonc; 


Z |e 





double 
double 
double 
double 
double 
double 
double 
double 
double 
double 
double 
double 


Boolean 


double 
double 
double 
double 
Str255 
long 

double 


D[{kParameters][kParameters]; 
Dinv{kParameters]{[kParameters]; 
dtheta[kParameters]={0.0,0.0,0.0}; 
dthetaSum[kParameters]={0.0,0.0,0.0}, 
Z0=0.0, Z1; 

di_x,dl_y,d_z, dl; 

d2_x, d2_y, d2; 

g{kNumExpt1], gl{[kKNumExp+1]; 
dthetaVec; 

XPex2e yl, yz: 

lamdal, lamda2; 

feasl, feas2, feas3, rhomax; 
nextlter=true; 

“eya, bere e-lamda: 

*wtrue; 

* dwtrue; 

*wmeas; 

numstr, thetaString; 

thestring; 

maxR=5000.0, maxD=-5000.0, minD=-1.0; 


wtrue = calloc(3L*(kStep*kNumExpt1),sizeof(double)); 


if(wtrue == NULL) 
{ 
DrawsString("\pCan't allocate memory for data collection!!!"); 


abort(Q); 
} 


wmeas = calloc(3L*(kStep*kNumExpt]1),sizeof(double)); 

if(wmeas == NULL) 

{ 
Drawstring("\pCan't allocate memory for data collection!!!"); 
abortQ; 


} 


dwtrue = calloc(3L*(kStep*kNumExpt1),sizeof(double)), 
if(dwtrue == NULL) 


{ 
DrawString("\pCan't allocate memory for data collection!!!"); 
abortQ); 

} 

e = calloc(kKNumExp*kNumMeas,sizeof(double)), 

if (e == NULL) 

{ 
DrawsString("\pCan't allocate memory for data collection!!!"); 
abortQ; 

} 

a = calloc(kkNumExp*kNumMeas,sizeof(double)); 

if (a == NULL) 

{ 


DrawString("\pCan't allocate memory for data collection!!!"); 
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abort(); 


} 

b = calloc(kNumExp*kParameters,sizeof(double)); 
if (6 == NULL) 

{ 


DrawString("\pCan't allocate memory for data collection!!!"); 
abort0; 


c = calloc(kNumExp,sizeof(double)), 

if (¢ == NULL) 

f 

a 
DrawString("\pCan't allocate memory for data collection!!!"); 
abort(); 

} 

lamda = calloc(kNumExp,sizeof(double)), 

if (lamda == NULL) 

{ 
DrawString("\pCan't allocate memory for data collection!!!"); 
abort(); 

} 


f=] .0/sqrt(2.0); 


for(u=0;u<kNumExp;ut+) 
{ 
index 1=3*(u*kSteptnumExp), 
if(indexl >= 3*kStep*(kNumExp+tl)) 
index 1=index1-3*kStep*(kNumExp+1); 


index 2=3 *((utkNumExp/2)*kStep+numExp); 
if(index2 >= 3*kStep*(kNumExp+1)) 
index2=index2-3 *kStep*(kNumExp+1); 


for(i=0;1<3;1++) 

{ 
wtrue[{kNumMeas* ut+i]=gw{index | +1]; 
wtrue[kKNumMeas*utit+3]=gw{index2+i]; 
wmeas[kNumMeas*u+ti]=gw[index I +1]; 
wmeas{kNumMeas*utit+3]=gw[index2+i]; 


} 


while(stopval > epsilon) 
{ 
numlterations++; 
for(i=0;1<kParameters;i++) 
{ 
dthetaSum[i]=0.0; 
for §=0:)<3,j++) 
D{1]j)=0.0; 


Z0=0.0; 


7A) dE 





for(u=0;u<kNumExp;u++) 


{ 


for(i=0;i<kNumMeas;i++) 
{ 
e[6* uti ]=wtrue[6 *uti]-wmeas[6* uti]; 


} 


dl_x=(wtrue[6*u]-theta[0])*(wtrue[6*u]-theta[0]); 
dl_y=(wtrue[6*u+1]-theta[1])*(wtrue[6*u+]]-theta[1]); 
d_z=theta[2]*theta[2]; 

dl=sqrt(d1_x+d1_y+d_z), 


d2_x=(wtrue[6*u+3]-theta[0])* (wtrue[6*ut3 ]-theta[0]); 
d2_y=(wtrue[6*u+4]-theta[1])*(wtrue[6*ut+4]-theta[1]); 
d2=sqrt(d2_x+d2_y+d_z); 


g[u]=d 1 -d2-Cs* wtrue[6*u+2]+Cs* wtrue[6*ut5]; 


a[6*ut+O]= (wtrue[6*ut+0]-theta[0])/d1,; 
a[6*u+1]= (wtrue[6*u+] ]-theta[1])/d1; 
a[6*ut+2]= -Cs; 
a[6*ut3]= -(wtrue[6*ut3]-theta[0])/d2; 
a[6*ut+4]= -(wtrue[6*ut4]-theta[1])/d2; 
a[6*ut+5]= Cs; 


b[3 *u+0]=(wtrue[6*ut+3]-theta[0])/d2-(wtrue[6*u+0]-theta[0])/d1, 
b[3 *ut] ]=(wtrue[6*u+4 ]-theta[1])/d2-(wtrue[6*u+1 ]-theta[1])/d1; 
b[3*ut2]=theta[2]/d1-theta[2]/d2; 
for(i=0;1<351++) 
if(b[3 *ut+i] == 0.0) 
b[3*uti]=le-6; 


c{u]=0.0; 

for(j=0;)<6;j)++) 
term=a[6*utj]*gV[j]*a[6*ut)]; 

c[uj=c[u]+term; 


for(i=0;1<3 514++) 


{ 
for(j=0;j<3;j++) 
{ 
Di UJ=DE]G)+C/c[u))* [3 * uti] *b[3 *uty)); 
} 
} 


dtheta Vec=0.0; 
for(1=0;1<6;1++) 
{ 
dtheta Vec=dtheta Vecta[6*uti] *e[6*uti]; 


} 
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// 


fori=0;1<351++) 

{ 
dthetaSum[1i]=dthetaSum[i]+(dtheta Vec-g[u])* b[3 *u+i]/c[u]; 

} 


Z0=Z0+g[u]*g[u]/c[u]; 
} 


x 1=D[1]{1]-D[O][1]* D1] (0]/D[0][0}; 
x2=D[1]{2]-D[0][2]*D[1](9]/D[0][9], 
y I=D[2][1]-D[O][1]*D[2][0}/D[0][0]; 
y2=D[2][2]-D[9][2]*D[2}[0]/D[0][0]; 


Dinv[2][2]=x1/(x1*y2-x2*y 1); 
Dinv[1][2]=-x2/(x1#y2-x2*y 1); 


Dinv[2][1]=-y 1/(x 1 *y2-x2*y 1); 
Dinv[1][1J=(1.0+x2*y 1/(x1 ty 2-x2*y1))/x1; 
Dinv(0][1]=-(D[0][1]* Dinv[1)[1]+D[0][2]* Dinv[2](1})/D[0][0]; 


Dinv[2][OJ=(x 1/(x 1 *y2-x2*y1))* 
(-D[2][0}/D[0][0]+(D[1][0] *y AD[O][0]*x1)); 

Dinv[(1](0J=-(D[1 ][0]/D[0][0]+x2* Dinv[2][0])/x 1; 

Dinv[0][0]=(1.0-(D[0][ 1] * Dinv{1][0]+D[0][2]* Dinv[2][0]))/D[0][0]; 


for(i=0;1<kParameters;i++) 

{ 
dtheta[i]=0.0; 
for(=0;)<kParameters;}++) 


dtheta[i]=dtheta[i]+Dinv[i}[j]*dthetaSum{}]; 
} 


for(u=0;u<kNumExp;ut+) 
{ 
lamda 1=0.0; 
for(i=0;1<351++) 
{ 
lamda 1=lamda 1+b[3 *u+i]* dtheta[1]; 
} 
lamda2=0.0; 
for(i=0;1<6;1++) 
{ 
lamda2=lamda2+a[6* uti] *e[6*uti]; 


} 
lamda[u]=(lamda 1 -lamda2+g[u])/c[u]; 


for(i=0;1<6;1++) 
{ 


term=gV[i]*a[6*uti]; 
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dwtrue[6*u+i]=-e[6*u+i]-lamda[u]* 2 V[i]*a[6*uti]; 
} 


if(dtheta[0] >= 0.0) 
feas!=(kMaxR-theta[0])/dtheta[0]; 
if(dtheta[0] < 0.0) 
feas |=(kMaxR+theta[0])/(-dtheta[0]); 


if(dtheta[1] >= 0.0) 
feas2=(kMaxR-theta[1])/dtheta[ 1}; 
if(dtheta[1] < 0.0) 
feas2=(kMaxR+theta[ 1])/(-dtheta[1]); 


if(dtheta[2] >= 0.0) 
feas3=(kMinD-theta[2])/dtheta[2]; 

if(dtheta[2] < 0.0) 
feas3=(kMaxD-theta[2])/dtheta[2]; 


rhomax=1.0; 

if(feas] < rhomax) 
thomax = feas1l; 

if(feas2 < rhomax) 
thomax = feas2; 

if(feas3 < rhomax) 
thomax=feas3; 


epsilon=(gtheta[0}]+0.001)/1e6; 
if(epsilon < 0) 
epsilon=-epsilon; 
epsilonc=(gtheta[1]+0.001)/1e6; 
if(epsilone < 0) 
epsilonc=-epsilonc; 
if(epsilonc < epsilon) 
epsilon=epsilonc; 
epsilonc=(gtheta[2]+0.001)/1e6; 
if(epsilone < 0) 
epsilonc=-epsilonc; 
if(epsilonc < epsilon) 
epsilon=epsilonc; 


nextIteration=0; 
while(nextIteration == 0) 
{ 
Z1=0.0; 
for(u=0;u<kNumExp;u++) 
{ 
dl_x=((wtrue[6*u]+rhomax* f* dwtrue[6*u]) 
-(gtheta[0]+thomax* f*dtheta[0]))* 
((wtrue[6* u]+rhomax* f*dwtrue[6*u]) 
-(gtheta[0]+rhomax* f*dtheta[0])); 
dl_y=((wtrue[6*ut1]+thomax* f*dwtrue[6*ut1]) 
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} 


-(gtheta[ 1 ]+rhomax* f*dtheta[1]))* 
((wtrue[6*u+] ]+rhomax* f¥dwtrue[6*ut] }) 
-(gtheta[ 1 ]+rhomax* f*dtheta[1])); 
d_z=(gtheta[2]+rhomax* f* dtheta[2])* (gtheta[2]+thomax* f* dtheta[2]); 
dl=sqrt(d1_x+dl_ytd_z); 


d2_x=((wtrue[6*ut3]+rhomax* f* dwtrue[6*u+3]) 
-(gtheta[0]++homax* f*dtheta[0]))* 
((wtrue[6*ut+3 ]+trhomax* f*dwtrue[6*ut3]) 
-(gtheta[0]+rhomax* f*dtheta[0])); 
d2_y=((wtrue[6*ut+4]+rhomax * f*dwtrue[6*ut4]) 
-(gtheta[ 1]+rhomax*f*dtheta[1]))* 
((wtrue[6*ut+4]+rhomax* f*dwtrue[6*u+4]) 
-(gtheta[ 1 ]+rhomax* f*dtheta[1])); 
d2=sqrt(d2_x+d2_y+d_z); 


g[uJ=d1-d2 
-Cs*(wtrue[6*u+2]+rhomax* f*dwtrue[6*u+2]) 
+Cs*(wtrue[6*ut+5]+rhomax* f* dwtrue[6*ut5]); 


Z1=Z1+g1[u]*gl[uJ/c[u]; 


if(noUpdate > 5) Z1=0.0; 
if(Z1 < ZO) 


{ 


} 

else 
} 
MoveTo(50,150); 


noUpdate=0; 
nextIteration=1; 
for(i=0;1<351++) 


{ 
theta[i]=theta[i]+rhomax*f* dtheta[1]; 
gPosition[i]=gPosition[i]+theta[1]; 
} 
for(u=0;u<kNumExp;u++) 
{ 
for(i=0;1<6;1++) 
wtrue[6* uti]=wtrue[6*uti] 
+rhomax* f* dwtrue[6*u+1]; 
} 


rhomax=rhomax/2.0; 
noUpdate++; 


thestring=theta([0]; 
NumToString(thestring,&numstr); 
DrawString(numstr); 


DrawString("\p : 


ms) 


thestring=theta|[ 1]; 
NumToString(thestring,&numstr); 


Papa), 





DrawString(numstr), 
DrawString("\p : "); 
thestring=theta|[ 2}; 
NumToString(thestring,&numstr); 
DrawString(numstr), 
for(i=0;1<10;1++) ScrollDataScanQ); 


if(numiIterations > 50) 
stopval=0.0; 


else 
{ 
if(dtheta[0} < 0) 
stopval=-dtheta[0}; 
else 
stopval=dtheta[0]; 
} 


} 


if(mumExp < (kKNumExp+t1)*kStep-1) 
gnumExp=gnumExptlL; 
else 
gnumExp=0L; 


free(wtrue); 
free(wmeas), 
free(dwtrue); 
free(e); 
free(a); 
free(b); 
free(c); 
free(lamda); 
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